Relative angle detection device for connected vehicles
By using a shooting and irradiation device in the connected vehicle to detect the relative angle of the towed vehicle, the burden and aesthetic problems of setting a target in the prior art are solved, and the effect of markless detection is achieved.
Patent Information
- Application Number
- CN202380036208.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-04-28
- Filing Date
- 2023-03-08
- Publication Date
- 2024-12-06
AI Technical Summary
In the prior art, the relative angle detection device connecting the vehicle requires a target to be provided in the front of the towed vehicle, resulting in an increase in the system setup burden and affecting the aesthetics.
The photographing device is used to photograph the towed vehicle on the other side from one side of the traction vehicle, and to irradiate marking light to the position of the photographing object through the irradiation device, and to analyze the captured image by the image analysis device to detect the relative angle of the towed vehicle relative to the towed vehicle .
The relative angle detection of the towed vehicle relative to the towed vehicle is realized without setting marks on the towed vehicle, simplifying the system settings and improving aesthetics.
Smart Images

Figure CN119096113A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a relative angle detection device for a coupled vehicle, which is used for a coupled vehicle in which a towed vehicle is towed by a towing vehicle, and detects the relative angle of the towed vehicle relative to the towing vehicle. Background Art
[0002] Conventionally, some coupled vehicles, which are a towed vehicle and a towing vehicle coupled together, can detect a hitch angle, which is an angle of the towed vehicle relative to the towing vehicle when the coupled vehicles are viewed from above.
[0003] The towing assist system described in Patent Document 1 uses a camera disposed at the rear of the towing vehicle to capture a target of the towed vehicle (trailer), and detects the hitch angle by analyzing the captured image. As the target, a mark of a predetermined shape such as an icon disposed at the front of the towed vehicle is used. For example, FIG. 1 of Patent Document 1 shows a panel with a cross-shaped figure as the target.
[0004] Patent Document 1: U.S. Patent No. 9950738
[0005] In a system that detects the hitch angle based on an image obtained by photographing a target on the towed vehicle side, such as the towing assist system described in Patent Document 1, a panel or a thin plate serving as a target needs to be provided at the front of the towed vehicle, which increases the installation burden of the system. In addition, the installation of the target may also affect the appearance of the towed vehicle. Summary of the invention
[0006] Therefore, an object of the present invention is to provide a relative angle detection device for coupled vehicles, which can detect the relative angle of a towed vehicle with respect to a towing vehicle without providing a mark of a photographic object for detecting the relative angle with the towing vehicle on the towed vehicle.
[0007] In order to achieve the above-mentioned object, the present invention provides the following relative angle detection device for connected vehicles, which is used for a connected vehicle in which a tractor vehicle and a towed vehicle are connected by a tractor-side connecting component and a towed-side connecting component, and comprises: a photographing device for photographing one side of the tractor vehicle and the towed vehicle from the other side; an irradiation device for irradiating a marking light to a photographing object position of the photographing device; and an image analysis device for analyzing an image photographed by the photographing device to detect the relative angle of the towed vehicle with respect to the tractor vehicle.
[0008] According to the present invention, the relative angle of the towed vehicle with respect to the towing vehicle can be detected without providing a mark of a photographic object for detecting the relative angle with the towing vehicle on the towed vehicle. BRIEF DESCRIPTION OF THE DRAWINGS
[0009] Figure 1A It is a schematic diagram showing a state of a connected vehicle as a detection target of a relative angle according to an embodiment of the present invention, as viewed from above.
[0010] Figure 1B This is a schematic diagram showing a state of the connected vehicles as viewed from the left side with respect to the advancing direction.
[0011] Figure 1C This is a schematic diagram showing a state of a connected vehicle as viewed from the rear.
[0012] Figure 2A It is a structural diagram showing an example of the structure of the traction-side connecting member and the pulled-side connecting member.
[0013] Figure 2B It is a cross-sectional view showing a state in which the traction-side coupling member and the pulled-side coupling member are combined.
[0014] Figure 3 This is a block diagram showing an example of the functional configuration of a relative angle detection device.
[0015] Figure 4 This is a flowchart showing an example of the procedure of the processing performed by the relative angle detection device.
[0016] Figure 5A It is an explanatory diagram showing the arrangement positions of the imaging device and the irradiation device in the connected vehicle according to the first embodiment.
[0017] Figure 5B It is an explanatory diagram showing the arrangement positions of the imaging device and the irradiation device in the connected vehicle according to the first embodiment.
[0018] Fig. 6A This is an explanatory diagram showing an image captured by the imaging device according to the first embodiment.
[0019] Figure 6B This is an explanatory diagram showing an image captured by the imaging device according to the first embodiment.
[0020] Figure 7 It is an explanatory diagram showing the arrangement positions of the imaging device and the illuminating device in the connected vehicle involved in the second embodiment.
[0021] Fig. 8A This is an explanatory diagram showing a state of a towed vehicle irradiated with marking light from the irradiation device according to the second embodiment, as viewed from the towing vehicle side.
[0022] Figure 8B This is an explanatory diagram showing a state of a towed vehicle irradiated with marking light from the irradiation device according to the second embodiment, as viewed from the towing vehicle side.
[0023] Figure 8C This is an explanatory diagram showing a state of a towed vehicle irradiated with marking light from the irradiation device according to the second embodiment, as viewed from the towing vehicle side.
[0024] Fig.8D This is an explanatory diagram showing a state of a towed vehicle irradiated with marking light from the irradiation device according to the second embodiment, as viewed from the towing vehicle side.
[0025] Fig. 9 It is an explanatory diagram showing the arrangement positions of the imaging device and the illuminating device in the connected vehicle involved in the third embodiment.
[0026] Fig. 10A This is an explanatory diagram showing a state of a towed vehicle irradiated with marking light from the irradiation device according to the third embodiment, as viewed from the towing vehicle side.
[0027] Fig. 10B This is an explanatory diagram showing a state of a towed vehicle irradiated with marking light from the irradiation device according to the third embodiment, as viewed from the towing vehicle side.
[0028] Fig. 10C This is an explanatory diagram showing a state of a towed vehicle irradiated with marking light from the irradiation device according to the third embodiment, as viewed from the towing vehicle side. DETAILED DESCRIPTION
[0029] [Implementation Method]
[0030] The embodiments of the present invention are described with reference to the accompanying drawings. In addition, the embodiments and examples described below are shown as preferred specific examples for implementing the present invention, and there are also parts that specifically illustrate various technical matters that are technically preferred, but the technical scope of the present invention is not limited to these specific forms.
[0031] Figure 1A , Figure 1B as well as Figure 1C It is a schematic diagram showing a coupled vehicle 1 equipped with a relative angle detection device according to an embodiment of the present invention. Figure 1A The state of the connected vehicle 1 as viewed from above is shown. Figure 1B The left side surface of the vehicle 1 with respect to the advancing direction is shown. Figure 1C , the state of the connected vehicle 1 is shown as viewed from the rear. Figure 1A and Figure 1B , a center line 2a of the tractor vehicle 2 along the front-rear direction of the tractor vehicle 2 and a center line 3a of the towed vehicle 3 along the front-rear direction of the towed vehicle 3 are indicated by dot-dash lines, respectively.
[0032] The coupled vehicle 1 includes a tractor vehicle 2 and a towed vehicle 3, and the tractor vehicle 2 and the towed vehicle 3 are coupled by a tractor-side coupling member 4 and a towed-side coupling member 5. Figure 1A , Figure 1B , Figure 1C In the figure, the towed vehicle 3 is a box-shaped camper, but the towed vehicle is not limited to this, and may be, for example, a boat trailer carrying a small boat. In addition, the towing vehicle 2 may be a manual driving vehicle in which the driver performs driving operations such as steering operation, or an automatic driving vehicle in which part or all of the driving operations are automatically performed.
[0033] Figure 2A It is a structural diagram showing an example of the structure of the traction-side connecting member 4 and the pulled-side connecting member 5 . Figure 2B It is a cross-sectional view of a state in which the traction-side coupling member 4 and the pulled-side coupling member 5 are combined.
[0034] The traction-side connecting member 4 includes a hook cross beam 41 disposed along the vehicle width direction of the tractor 2, a pair of hook longitudinal beams 42 fixed to both ends of the hook cross beam 41, a ball seat 43 protruding from the center of the hook cross beam 41 in the vehicle width direction toward the rear side of the tractor 2, a hook pin 44 protruding upward from the ball seat 43, and a spherical hook ball 45 integrally provided with the upper end of the hook pin 44. The hook cross beam 41 and the pair of hook longitudinal beams 42 are disposed on the inner side of the rear bumper 21 of the tractor 2, and the ball seat 43, the hook pin 44, and the hook ball 45 are exposed from the rear bumper 21 to the rear side. The pair of hook longitudinal beams 42 are fixed to the body of the tractor 2 by a plurality of bolts.
[0035] The towed-side coupling member 5 includes a connector 51 covering the hitch ball 45, a locking mechanism 52 for preventing the connector 51 from being disengaged from the hitch ball 45, a rod-shaped armature 53 for fixing the connector 51 to the front end, and a pair of side beams 54 extending in a direction inclined with respect to the long-side direction of the armature 53. One end of each of the side beams 54 is connected to the armature 53. The base end of the armature 53 and the other end of each of the pair of side beams 54 are connected to the chassis of the towed vehicle 3.
[0036] like Figure 2BAs shown, the connector 51 has a cup portion 511 for accommodating the hook ball 45. The locking mechanism 52 has: a rod support body 520; a rod 521 that is rotatably operated relative to the rod support body 520; a locking plate 522 that is opposite to the upper surface 51a of the connector 51; a locking rod 523 that enters between the upper surface 51a of the connector 51 and the locking plate 522 when the rod 521 is operated; a locking plate 524 that receives the hook ball 45 from the lower side; a coil spring 525 that applies force to the locking plate 524 downward; and a bolt 526 and a nut 527 that connect the locking plate 522 and the locking plate 524.
[0037] The locking plate 524 can rotate around the support pin 512 horizontally provided on the connector 51. Figure 2B The locking plate 522 is lifted upward relative to the connector 51 by the locking rod 523, and the locking plate 524 prevents the hook ball 45 from falling off. The inner surface 511a of the cup 511 in the connector 51 is a concave spherical surface with a curvature corresponding to the curvature of the surface 45a of the hook ball 45. The connector 51 can swing in all directions with the hook ball 45 as the center due to the sliding between the inner surface 511a of the cup 511 and the surface 45a of the hook ball 45.
[0038] For the coupled vehicle 1, the relative angle of the towed vehicle 3 with respect to the towing vehicle 2 varies. In particular, when the towed vehicle 3 is moving backward in the forward direction, the relative angle of the towed vehicle 3 with respect to the towing vehicle 2 becomes important in driving operations. Therefore, the coupled vehicle 1 is provided with a relative angle detection device. When the towing vehicle 2 is a manual driving vehicle (non-automatic driving vehicle), an image showing the detection result of the relative angle detection device is displayed on a display arranged in the cabin of the towing vehicle 2 to assist the driver's driving operation. In addition, when the towing vehicle 2 is an automatic driving vehicle, the towing vehicle 2 is automatically steered based on the detection result of the relative angle detection device.
[0039] The relative angles of the towed vehicle 3 relative to the tractor vehicle 2 include: the hitch angle, which indicates the horizontal tilt of the towed vehicle 3 relative to the tractor vehicle 2; the relative pitch angle, which indicates the vertical tilt of the towed vehicle 3 relative to the tractor vehicle 2; and the relative roll angle, which is the difference between the roll angle of the tractor vehicle 2 and the roll angle of the towed vehicle 3. Figure 1A , the hitch angle θh is shown when the towed vehicle 3 is tilted to the left relative to the towing vehicle 2. Figure 1B , the relative pitch angle θp when the towed vehicle 3 is tilted upward relative to the towing vehicle 2 is shown. Figure 1C Graph 2 shows the relative roll angle θr when the towed vehicle 3 is tilted clockwise with respect to the towing vehicle 2 when viewed from the rear side of the coupling vehicle 1 .
[0040] The relative angle detection device according to the present embodiment can detect at least the hook angle and the relative pitch angle among the hook angle, the relative pitch angle, and the relative roll angle. Next, the structure, arrangement, and operation of the relative angle detection device will be described.
[0041] Figure 3 : is a block diagram showing the functional structure of the relative angle detection device 6. The relative angle detection device 6 includes: a camera 61 for capturing an image of one side of the tractor vehicle 2 and the towed vehicle 3; an irradiation device 62 for irradiating a marking light to a position of a photographing object of the camera 61; and an image analysis device 63 for analyzing an image captured by the camera 61 to detect a relative angle of the towed vehicle 3 with respect to the tractor vehicle 2.
[0042] The irradiation device 62 projects a figure of a specified shape by means of identification light. Here, the figure refers to a line segment of a specified length, a curve or a broken line, or a closed curve such as a polygon or an ellipse, or one or more points. As the identification light, a laser with excellent linearity is used. The color of the identification light is not particularly limited. For example, a blue, red or green visible light laser can be used as the identification light. In this case, a visible light camera is used as the photographing device 61. In addition, the identification light may also be invisible light such as infrared light and ultraviolet light. In this case, a photographing device such as an infrared camera that can photograph light of the wavelength of the identification light is used as the photographing device 61.
[0043] The photographing device 61 photographs the image projected by the marking light irradiated by the irradiating device 62, and detects the relative angle of the towed vehicle 3 with respect to the towing vehicle 2 based on the shape of the photographed image. The detection result of the relative angle is sent to the display device 7 of the towing vehicle 2, for example. Figure 3 As shown in FIG. 1 , an image showing the detection result of the relative angle detection device 6 is displayed on a display 71 in the vehicle interior. Figure 3 2 shows a display example in which a bird's-eye view image 710 is displayed in the first display area 71a of the display 71. The bird's-eye view image 710 shows a graphic symbol 711 representing the tractor vehicle 2 and a graphic symbol 712 representing the towed vehicle 3 in a state of being tilted according to the hitch angle detected by the relative angle detection device 6. The second display area 71b of the display 71 displays an image captured by the camera 61, for example.
[0044] The driver performs the steering operation with reference to the display content of the display 71. The display 71 may also display an image showing the rotation direction of the steering wheel recommended according to the hitch angle detected by the relative angle detection device 6. In addition, when the tractor vehicle 2 is an automatic driving vehicle, the detection result of the relative angle detection device 6 is output to the automatic driving device 8.
[0045] The irradiation device 62 irradiates the identification light at least when the coupled vehicle 1 moves backward. In the case where the towing vehicle 2 is a manually driven vehicle, the irradiation device 62 irradiates the identification light when the shift lever is shifted to the R (reverse) gear, for example, and stops irradiating the identification light when the gear is shifted from the R gear to another gear. In addition, the irradiation device 62 may also irradiate the identification light in accordance with the switch operation of the driver. Even when the coupled vehicle 1 is moving forward, for example, the state of the towed vehicle 3 may become unstable due to the inclination of the road surface or crosswind. In such a case, the irradiation device 62 irradiates the identification light in accordance with the switch operation of the driver, and the relative angle detection device 6 detects the coupling angle, etc., thereby assisting the driver's driving operation. In addition, in the case where the towing vehicle 2 is an automatic driving vehicle, the irradiation device 62 starts and stops irradiating the identification light in accordance with the command signal from the automatic driving device 8.
[0046] Figure 4 2 is a flowchart showing an example of a procedure of processing performed by the relative angle detection device 6. The relative angle detection device 6 repeatedly executes the processing shown in the flowchart at a predetermined cycle of, for example, several ms to several tens of ms.
[0047] The relative angle detection device 6 first determines whether to perform the detection process of the relative angle of the towed vehicle 3 with respect to the towing vehicle 2 (step S1). As described above, this determination can be made, for example, based on a driving operation or switch operation performed by the driver to move backward, or a command signal from the automatic driving device 8. If the result of this determination is yes, the irradiation device 62 irradiates the marking light (step S2), and the camera 61 captures the image projected by the marking light (step S3). Information on the image captured by the camera 61 is sent to the image analysis device 63.
[0048] The image analysis device 63 analyzes the image captured by the camera 61 and detects the relative angle of the towed vehicle 3 with respect to the towing vehicle 2 (step S4). For example, the shape of the indicator light when the hitch angle, relative pitch angle, and relative roll angle are all zero can be stored in advance as a reference shape, and the reference shape and the shape of the indicator light in the image captured by the camera 61 can be compared to obtain the change in shape, and the change is converted into a relative angle to perform the analysis in step S4. In addition, the relative angle detection result in the previous cycle can also be referred to to perform the detection of the relative angle in this cycle.
[0049] On the other hand, if the determination result in step S1 is NO, the irradiation device 62 stops irradiation of the marker light (step S5 ), and the image analysis device 63 initializes the detection result of the relative angle (step S6 ).
[0050] Next, Examples 1 to 3 of the relative angle detection device 6 will be described in detail.
[0051] [Example 1]
[0052] Figure 5A and Figure 5B It is an explanatory diagram showing the arrangement positions of the imaging device 61 and the irradiation device 62 in the connected vehicle 1 according to the first embodiment. Figure 5A The rear side of the towing vehicle 2 is shown as viewed from the towed vehicle 3 side. Figure 5B The traction-side coupling member 4 and the towed-side coupling member 5 as well as a portion of the traction vehicle 2 and the towed vehicle 3 are shown as viewed from the left side of the traction vehicle 2 .
[0053] In the first embodiment, the camera 61 and the illumination device 62 are installed at the rear end of the towing vehicle 2. More specifically, the camera 61 and the illumination device 62 are installed on the outer side of the rear tailgate 22 of the towing vehicle 2. The illumination device 62 is installed between the license plate 23 and the rear window glass 221 of the rear tailgate 22. The camera 61 is arranged above the illumination device 62 to capture the towed vehicle 3 side. Figure 5A In the example shown, the imaging device 61 is disposed directly above the irradiation device 62 , but the imaging device 61 may be positioned offset from the irradiation device 62 in the vehicle width direction of the tractor vehicle 2 .
[0054] In this example, the figure projected by the marking light irradiated by the irradiation device 62 is a line segment of a predetermined length parallel to the vehicle width direction of the tractor vehicle 2. Figure 5A , the field angle VA indicating the imaging range of the imaging device 61 and the irradiation range R of the marker light of the irradiation device 62 are shown. Figure 5B In FIG. 1 , the direction of the marking light irradiated by the irradiation device 62 is indicated by a dashed line DL. The irradiation range of the marking light of the irradiation device 62 includes the towed-side coupling member 5 and the road surface 9 on both sides of the towed-side coupling member 5 in the vehicle width direction of the towing vehicle 2. In this example, the irradiation device 62 irradiates the armature 53 of the towed-side coupling member 5, but it is not limited to this, and for example, the connector 51 may be irradiated. The field of view VA of the camera 61 includes the entire irradiation range R of the irradiation device 62. In addition, the road surface 9 is, for example, a paved road surface, but it may also be an unpaved ground or the surface of a parking space in a parking lot.
[0055] Fig. 6A and Figure 6B 1 is an explanatory diagram showing an image captured by the imaging device 61. In the following description, the right side and the left side refer to the right side and the left side of the image captured by the imaging device 61. Fig. 6A The tractor vehicle 2 and the towed vehicle 3 are arranged in a straight line, and the coupling angle is zero. Figure 6BThe towed vehicle 3 is shown in a state where it is tilted to the right with respect to the towing vehicle 2 .
[0056] The camera device 61 is arranged at a position higher than the illuminating device 62, so in the image captured by the camera device 61, the first illuminating unit 621 indicating the identification light irradiated on the portion of the traction-side connecting component 5 appears higher than the second illuminating unit 622 indicating the identification light irradiated on the portion of the road surface 9 located on the left side of the traction-side connecting component 5 and the third illuminating unit 623 indicating the identification light irradiated on the portion of the road surface 9 located on the right side of the traction-side connecting component 5.
[0057] exist Fig. 6A , Figure 6B , the length of the entire first to third irradiation sections 621 to 623 in the left-right direction of the image captured by the camera 61 is represented by L0, the length of the first irradiation section 621 is represented by L1, the length of the second irradiation section 622 is represented by L2, and the length of the third irradiation section 623 is represented by L3. More specifically, the length L1 is the length between the left end and the right end of the portion of the armature 53 irradiated by the irradiation device 62. The length L2 is the length from the left end of the road surface 9 irradiated by the irradiation device 62 to the left end of the armature 53 of the portion irradiated by the irradiation device 62. The length L3 is the length from the right end of the road surface 9 irradiated by the irradiation device 62 to the right end of the armature 53 of the portion irradiated by the irradiation device 62. The length L0 is the length from the left end to the right end of the road surface 9 irradiated by the irradiation device 62. The lengths L1, L2, and L3 are index values indicating the position of the towed-side coupling member 5 in the vehicle width direction within the irradiation range (length L0) of the marking light.
[0058] In the image captured by the camera 61, when the midpoint of the length L0 is used as the reference position, the center position of the armature 53 in the left-right direction relative to the reference position can be obtained by the calculation formula of L0 / 2-((L2+L1 / 2) / (L1+L2+L3))×L0. In addition, the positional relationship between the camera 61, the irradiation device 62, the hitch ball 45, etc. is known, so the hitch angle can be calculated based on the above calculation formula. In this way, the image analysis device 63 detects the hitch angle of the connected vehicle 1 based on the position of the towed side connecting member 5 in the vehicle width direction within the irradiation range of the marking light.
[0059] In the image captured by the camera 61, the vertical distance D between the first irradiation unit 621 and the second irradiation unit 622 and the third irradiation unit 623 changes according to the relative pitch angle, so the relative pitch angle can be obtained based on the distance D. The distance D is an index value indicating the position difference in the front-rear direction of the traction vehicle 2 between the towed-side coupling member 5 irradiated with the marking light and the road surface 9. That is, the image analysis device 63 detects the relative pitch angle of the coupling vehicle 1 based on the position difference in the front-rear direction of the traction vehicle 2 between the towed-side coupling member 5 irradiated with the marking light and the road surface 9.
[0060] The image analysis device 63 obtains image information from the imaging device 61 at a predetermined cycle, calculates the hook angle and the relative pitch angle, and outputs them as detection results. In addition, as the hook angle increases, the marker light also irradiates the side surface of the armature 53 in the left-right direction, so the length L1 of the first irradiation portion 621 increases. Therefore, in the calculation to obtain the hook angle, it is necessary to correct the center position of the armature 53 in the left-right direction by using the hook angle calculated in the previous cycle, for example. In addition, the correction can also be performed by referring to the mapping information storing the relationship between the calculation result of the above-mentioned calculation formula and the actual center position of the armature 53 in the left-right direction.
[0061] [Example 2]
[0062] Figure 7 1 is an explanatory diagram showing the arrangement positions of the camera 61 and the irradiation device 62 in the coupling vehicle 1 according to the second embodiment. In this example, the camera 61 is installed at the rear end of the tractor vehicle 2 as in the first embodiment, but the irradiation device 62 is installed at the towed side coupling member 5. The irradiation device 62 is fixed to the armature 53 via the bracket 55, and irradiates the front end of the towed vehicle 3 obliquely upward. Figure 7 In FIG. 1 , two dashed lines DL1 and DL2 indicate the irradiation range of the marking light of the irradiation device 62. The imaging device 61 is installed between the license plate 23 and the rear window glass 221 of the rear door 22, and is also used as a camera for a rear monitor.
[0063] Fig. 8A , Figure 8B , Figure 8C as well as Fig.8D 1 and 2 are explanatory diagrams showing a state of the towed vehicle 3 irradiated with the marking light from the irradiation device 62 as viewed from the towing vehicle 2 side. Fig. 8A The state in which the attachment angle, relative pitch angle and relative roll angle are all zero is shown. Figure 8B The figure shows a state where the towed vehicle 3 is tilted to the right when viewed from the towing vehicle 2 . Figure 8C The state in which the towed vehicle 3 is tilted upward is shown. Fig.8DThe state in which the towed vehicle 3 rolls counterclockwise is shown.
[0064] In this example, the projection pattern 624 projected by the marking light irradiated by the irradiation device 62 is an ellipse whose major axis is the vehicle width direction of the tractor vehicle 2 and whose minor axis is the vertical direction. Fig. 8A In the example, the major diameter of the projection pattern 624 is represented as D 11 , the short diameter is represented by D 12 . From the long diameter D 11 And short diameter D 12 The elliptical shape shown is the reference shape of the projection pattern 624. The major diameter D 11 And short diameter D 12 Stored in the image analysis device 63.
[0065] like Figure 8B As shown, if the towed vehicle 3 tilts in the left-right direction relative to the towing vehicle 2, the shape of the projection pattern 624 captured by the camera 61 is deformed, and the major diameter D 21 Become Fig. 8A The major diameter D of the projected figure 624 is shown 11 The major diameter D 21 With long diameter D 11 The difference is the deformation amount of the projection pattern 624 caused by the change in the hitch angle. The image analysis device 63 can obtain the hitch angle of the connected vehicle 1 by converting the deformation amount into the hitch angle. That is, in this example, the image analysis device 63 detects the hitch angle based on the size of the marking light in the vehicle width direction of the towing vehicle 2 captured by the camera 61.
[0066] In addition, for example, it can be determined whether the towed vehicle 3 is tilted to the left or right relative to the tractor 2, based on the difference between the shapes of the left and right ends of the projected figure 624 and the reference shape of the projected figure 624. This is because when the towed vehicle 3 is tilted to the right relative to the tractor 2, the right end of the projected figure 624 is larger than the reference shape, while the left end of the projected figure 624 is smaller than the reference shape, depending on the distance from the imaging device 61. When the towed vehicle 3 is tilted to the left relative to the tractor 2, the opposite is true.
[0067] like Figure 8C As shown, if the towed vehicle 3 is tilted in the vertical direction relative to the towing vehicle 2, the shape of the projection pattern 624 captured by the camera 61 is deformed, and the short diameter D 32 Become Fig. 8A The short diameter D of the projected figure 624 is shown 12 The short diameter D 32 With short diameter D 12The difference is the deformation amount of the projection figure 624 caused by the change in the relative pitch angle. The image analysis device 63 can obtain the relative pitch angle of the connected vehicle 1 by converting the deformation amount into the relative pitch angle. That is, in this example, the image analysis device 63 detects the relative coupling angle based on the size of the marking light in the up-down direction of the towing vehicle 2 captured by the camera 61. In addition, similar to the above-mentioned left-right inclination, for example, based on the difference between the shape of the upper and lower ends of the captured projection figure 624 and the reference shape of the projection figure 624, it can be determined whether the towed vehicle 3 is tilted relative to the towing vehicle 2, up or down.
[0068] like Fig.8D As shown in FIG. 1 , if the towed vehicle 3 rolls relative to the towing vehicle 2, the shape of the projection pattern 624 captured by the camera 61 is tilted relative to the reference shape. Fig.8D In FIG. 6 , the inclination angle of the long axis of the projection figure 624 relative to the reference shape is represented by θ. The inclination angle θ is the deformation amount of the projection figure 624 caused by the relative roll angle, and the image analysis device 63 can obtain the relative roll angle of the coupling vehicle 1 by converting the inclination angle θ into the relative roll angle. That is, in this example, the image analysis device 63 detects the relative coupling angle based on the inclination of the tractor 2 of the marker light captured by the camera 61.
[0069] [Example 3]
[0070] Fig. 9 1 is an explanatory diagram showing the arrangement positions of the camera 61 and the irradiation device 62 in the coupling vehicle 1 according to the third embodiment. In this example, the camera 61 and the irradiation device 62 are installed at the rear end of the tractor vehicle 2 as in the first embodiment, but the irradiation device 62 irradiates the towed vehicle 3 instead of the towed-side coupling member 5. Fig. 9 In FIG. 1 , the irradiation range of the marking light of the irradiation device 62 is shown by two dot-dash lines DL3 and DL4 .
[0071] The camera 61 captures a portion of the towed vehicle 3 illuminated by the marker light from the illumination device 62. As in the second embodiment, the image analysis device 63 detects the hitch angle, the relative pitch angle, and the relative roll angle based on the size in the vehicle width direction, the size in the up-down direction, and the inclination of the marker light captured by the camera 61.
[0072] However, the irradiation device 62 is mounted on the towing vehicle 2, so that the shape of the marking light photographed by the camera 61 is less likely to change according to the hitch angle, etc., compared with the second embodiment. Therefore, in this example, the irradiation device 62 irradiates the towed vehicle side in the position and range where a part of the marking light photographed by the camera 61 is missing according to the magnitude of the hitch angle.
[0073] Fig. 10A , Fig. 10B as well as Fig. 10C 1 and 2 are explanatory diagrams showing a state of the towed vehicle 3 irradiated with the marking light from the irradiation device 62 as viewed from the towing vehicle 2 side. Fig. 10A The state where the hitch angle is zero is shown. Fig. 10B The towed vehicle 3 is shown tilted to the right when viewed from the towing vehicle 2. Fig. 10C The towed vehicle 3 is shown in a state where it is tilted to the left when viewed from the towing vehicle 2. The shape of the projection pattern 625 projected by the marking light irradiated by the irradiation device 62 is an ellipse similarly to the second embodiment.
[0074] like Fig. 10A As shown, when the hitch angle is zero, the entire elliptical shape of the projection figure 625 is captured by the camera 61. If the towed vehicle 3 tilts in the left-right direction relative to the tractor 2, a portion of the projection figure 625 in the long axis direction is separated from the front end of the towed vehicle 3 and is lost, the shape of the projection figure 625 changes, and the length of the projection figure 625 in the vehicle width direction of the tractor 2 becomes shorter. The image analysis device 63 can obtain the hitch angle with high accuracy based on the amount of change in the shape of the projection figure 625.
[0075] (Effects of Embodiment and Examples 1 to 3)
[0076] According to the above-described implementation mode and Examples 1 to 3, the identification light irradiated by the irradiation device 62 is photographed by the photographing device 61, and the image analyzing device 63 detects the relative angle of the towed vehicle 3 with respect to the towing vehicle 2 based on the analysis of the photographed image. Therefore, the relative angle of the towed vehicle 3 with respect to the towing vehicle 2 can be detected without providing a mark such as a panel or a thin plate on the towed vehicle 3.
[0077] (Note)
[0078] The present invention has been described above based on the embodiments and examples, but the embodiments and examples do not limit the invention involved in the technical solution. In addition, it should be noted that the combination of features described in the embodiments is not all necessary for the means to solve the problems of the invention. In addition, the present invention can omit a part of the structure or add or replace the structure within the scope of its purpose, and can be implemented with appropriate deformation, for example, it can also be deformed and implemented as follows.
[0079] In the above-mentioned embodiments and examples, the case where the camera 61 is installed on the tractor vehicle 2 and photographs the towed vehicle 3 side is described, but conversely, the camera 61 may be installed on the towed vehicle 3 side and photograph the tractor vehicle 2 side. In this case, the irradiation device 62 irradiates the marking light from the towed vehicle 3 side toward the tractor vehicle 2 side.
[0080] In the above-mentioned embodiments 2 and 3, the projection figures 624 and 625 are described as being elliptical. However, the shapes of the projection figures 624 and 625 are not limited thereto. As long as they have a predetermined length in the vehicle width direction and the vertical direction of the tractor vehicle 2, they may be polygonal or broken lines, for example.
[0081] Description of Reference Numerals
[0082] 1...connecting vehicle; 2...tracting vehicle; 3...towed vehicle; 4...tracting-side connecting member; 5...towed-side connecting member; 6...relative angle detecting device; 61...photographing device; 62...illuminating device; 63...image analyzing device.
Claims
1. A relative angle detection device for a coupled vehicle, used for a coupled vehicle in which a tractor vehicle and a towed vehicle are coupled by a tractor-side coupling member and a towed-side coupling member, the relative angle detection device comprising: A photographing device for photographing one side of the towing vehicle and the towed vehicle from the other side; an irradiation device for irradiating a marking light toward a position of a photographing object of the photographing device; and The image analyzing device analyzes the image captured by the capturing device to detect the relative angle of the towed vehicle with respect to the towing vehicle.
2. The relative angle detection device for connecting vehicles according to claim 1, wherein: The photographing device is installed on the towing vehicle and photographs the towed vehicle side.
3. The relative angle detection device for connecting vehicles according to claim 1, wherein: The irradiation device projects a pattern of a predetermined shape through the marking light. The image analyzing device detects the relative angle according to the shape of the photographed figure.
4. The relative angle detection device for coupled vehicles according to claim 1, wherein: The relative angle detected by the image analyzing device includes a hitch angle of the coupled vehicle.
5. The relative angle detection device for coupled vehicles according to claim 1, wherein: The irradiation device irradiates the marking light when the coupled vehicle moves backward.
6. The relative angle detection device for coupled vehicles according to any one of claims 1 to 4, wherein: The photographing device and the irradiating device are installed on the tractor vehicle. The irradiation range of the marking light of the irradiation device includes the towed-side coupling member and road surfaces on both sides of the towed-side coupling member in a vehicle width direction of the towing vehicle.
7. The relative angle detection device for coupled vehicles according to claim 6, wherein: The image analysis device detects the coupling angle of the coupled vehicle based on the position of the towed-side coupling member in the vehicle width direction within the irradiation range of the marker light.
8. The relative angle detection device for coupled vehicles according to claim 6, wherein: The image analyzing device detects a pitch angle of the towed vehicle relative to the towing vehicle based on a difference in position in the front-rear direction of the towing vehicle between the towed-side coupling member irradiated with the marker light and the road surface.
9. The relative angle detection device for coupled vehicles according to any one of claims 1 to 5, wherein: The photographing device is installed on the tractor vehicle. The irradiation device is mounted on the towed-side coupling member or the towed vehicle and irradiates the towed vehicle.
10. The relative angle detection device for coupled vehicles according to claim 9, wherein: The image analysis device detects a hitch angle of the coupled vehicle based on the size of the captured marker light in the vehicle width direction of the towing vehicle.
11. The relative angle detection device for coupled vehicles according to claim 9, wherein: The image analysis device detects a pitch angle of the towed vehicle relative to the towing vehicle based on a magnitude of the captured marker light in a vertical direction of the towing vehicle.
12. The relative angle detection device for coupled vehicles according to claim 9, wherein: The image analysis device detects a roll angle of the towed vehicle relative to the towing vehicle based on the tilt of the captured identification light.
13. The relative angle detection device for coupled vehicles according to claim 9, wherein: The irradiation device irradiates the towed vehicle side at a position and a range where a part of the indicator light captured by the imaging device is missing according to the magnitude of the hitch angle of the coupled vehicle.
Citation Information
Patent Citations
Trailering assist system with trailer angle detection
US9950738B2
