Parking assistance device

The parking assist device calculates a trajectory that avoids obstacles by adjusting the path to prevent collisions, addressing the issue of bulge-induced contact in towing scenarios.

JP2024158183APending Publication Date: 2024-11-08AISIN CORP
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
JP2023073166
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-04-27
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

Conventional parking assistance systems for towing vehicles fail to consider the potential contact of a towed vehicle with obstacles due to the bulge formed during turning, leading to the possibility of setting an untraversable travel route.

Method used

A parking assist device that calculates a travel trajectory by detecting obstacles on the side of the parking target position, adjusting the trajectory to avoid overlap with these obstacles, and generating a path that minimizes bulge, ensuring the towed vehicle does not collide with them.

Benefits of technology

Generates an appropriate travel trajectory that avoids obstacles, preventing collisions and ensuring a safe parking path for both the towing and towed vehicles.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024158183000001_ABST
    Figure 2024158183000001_ABST
Patent Text Reader

Abstract

To provide a parking assistance device that is able to generate a more appropriate traveling track without generating a traveling track along which traveling is not allowed due to an obstacle.SOLUTION: When a parking start position and a parking target position are acquired and a traveling track from the parking start position to the parking target position is generated, an obstacle located on a side of the parking target position with respect to a towed vehicle 3 at the parking start position is detected as an obstacle that may affect parking; a distance from the towed vehicle 3 at the parking start position to the obstacle is acquired; determination whether a condition that a traveling track of the towed vehicle 3 does not overlap the obstacle is satisfied or not is made based on a distance from the towed vehicle 3 at a parking start position to the obstacle; and a traveling track for an advancing section is generated by giving priority to shortening of a route length in a range satisfying the condition.SELECTED DRAWING: Figure 9
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a parking assistance device that assists in parking a vehicle. [Background technology]

[0002] Conventionally, it has been known to calculate a driving trajectory for parking a vehicle as a parking assistance, and to provide guidance and vehicle control so that parking is performed according to the calculated driving trajectory. Here, the driving trajectory, particularly when performing reverse parking, is a driving trajectory in which the vehicle first moves forward to a suitable turning position for entering a parking target position such as a parking space, switches to reverse at the turning position, and then moves backward to the parking target position. However, when performing the parking assistance for a towing vehicle (tractor) towing a towed vehicle (trailer), it is necessary to set the above driving trajectory taking into consideration not only the behavior of the towing vehicle but also the behavior of the towed vehicle.

[0003] For example, JP 2022-107175 A proposes a technology in which a target path for the towing vehicle and towed vehicle is generated when the towing vehicle is towing the towed vehicle and parking it based on the parking start position, the parking target position, and the position of any obstacles, and then it is determined whether the maximum curvature of the generated target path for the towed vehicle is equal to or less than the maximum curvature at which the towed vehicle can turn, and if it is not, the turning position is reset to correct the target path. [Prior art documents] [Patent documents]

[0004] [Patent Document 1] JP 2022-107175 A (paragraphs 0059-0060) Summary of the Invention [Problem to be solved by the invention]

[0005] Fig. 12 shows the trajectory of the vehicle when the towing vehicle towing the towed vehicle moves forward while turning, and it is known that when the towing vehicle and towed vehicle turn right (or left) from a state where they are on a straight line or nearly so, as shown in Fig. 12, the towed vehicle will swerve slightly in the direction opposite to the turning direction. Therefore, when parking with a turn as described above, if there are obstacles 103 such as walls on the side of the parking target position 102 side of the towed vehicle 101 at the parking start position as shown in Fig. 13, there is a risk that the towed vehicle 101 will come into contact with these obstacles 103 in the forward section up to the turn position.

[0006] The above-mentioned Patent Document 1 takes into consideration the curvature of the target route of the towed vehicle, but does not consider the possibility of contact with an obstacle due to the above-mentioned bulge. As a result, there is a risk that the target route set will be impossible to travel due to the obstacle, depending on the position of the obstacle or the distance to the obstacle.

[0007] The present invention has been made to solve the above-mentioned problems in the conventional technology, and its object is to provide a parking assistance device that can generate a more appropriate driving trajectory without generating a driving trajectory that is impossible to drive due to an obstacle, by calculating the driving trajectory of the forward section taking into account obstacles that exist on the side of the towed vehicle, which is at the parking start position, on the side of the parking target position. [Means for solving the problem]

[0008] In order to achieve the above object, the parking assistance device of the present invention is a parking assistance device that assists in parking of a towing vehicle and a towed vehicle that is to be towed by the towing vehicle when the towing vehicle and the towed vehicle are coupled together, and includes a parking start position acquisition unit that acquires a parking start position, a parking target position acquisition unit that acquires a parking target position, a driving trajectory generation unit that generates a driving trajectory from the parking start position to the parking target position, an obstacle detection unit that detects an obstacle on the side of the towed vehicle at the parking start position on the side of the parking target position as an obstacle that may affect parking, and and an obstacle information acquisition unit that acquires the position of the obstacle or the distance to the obstacle, wherein the driving trajectory includes a forward section in which the towed vehicle moves forward while turning in a direction away from the parking start position toward the parking target position, and a reverse section in which the towed vehicle moves backward to the parking target position after turning around on the driving trajectory of the forward section, and the driving trajectory generation unit determines whether the driving trajectory of the towed vehicle satisfies a condition that it does not overlap with the obstacle based on the position of the obstacle relative to the towed vehicle which is at the parking start position or the distance to the obstacle, and generates the driving trajectory of the forward section so that the path length is shortened to the extent that the condition is satisfied. In addition, "the driving trajectory overlaps with an obstacle" refers not only to the case where the area in which the obstacle is located overlaps with the driving trajectory, but also to the case where the area in which the obstacle is located overlaps with the vehicle when the vehicle travels along the driving trajectory. Effect of the Invention

[0009] According to the parking assistance device of the present invention having the above-mentioned configuration, by calculating the driving trajectory of the forward section taking into account obstacles that exist on the side of the parking target position with respect to the towed vehicle, which is at the parking start position, it is possible to generate a more appropriate driving trajectory without generating a driving trajectory that is impossible to drive due to an obstacle. [Brief description of the drawings]

[0010] [Figure 1] FIG. 1 is a diagram showing a towing vehicle and a towed vehicle according to an embodiment of the present invention. [Diagram 2]FIG. 2 is an enlarged view of the vicinity of the towing device of the towing vehicle. [Diagram 3] FIG. 2 is a diagram showing the movement of the towing vehicle and the towed vehicle when the hitch ball and the coupler are connected. [Figure 4] 1 is a block diagram showing a configuration of a parking assistance device according to an embodiment of the present invention. [Diagram 5] 4 is a flowchart of a parking assistance processing program according to the embodiment. [Figure 6] FIG. 1 is a diagram showing examples of obstacles that may affect parking. [Figure 7] FIG. 13 is a diagram showing an example of a reference trajectory generated without taking obstacles into consideration. [Figure 8] FIG. 13 is a diagram showing the amount of bulging when traveling along a forward trajectory. [Figure 9] FIG. 13 is a diagram showing candidates for newly generated forward trajectories. [Figure 10] FIG. 13 is a diagram illustrating a method for calculating an initial receding distance. [Figure 11] FIG. 13 is a diagram showing a recommended driving trajectory from a parking start position to a parking target position that is generated by combining each trajectory. [Figure 12] FIG. 1 is a diagram illustrating problems with the conventional technology. [Figure 13] FIG. 1 is a diagram illustrating problems with the conventional technology. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0011] A specific embodiment of the parking assistance device according to the present invention will be described below in detail with reference to the drawings. First, a towing vehicle (tractor) 2 equipped with a parking assistance device 1 according to this embodiment and a towed vehicle (trailer) 3 towed by the towing vehicle 2 will be described below. Figure 1 shows the towing vehicle 2 and the towed vehicle 3.

[0012] Here, the towing vehicle 2 is also called a tractor, and is configured to be capable of traveling while towing a towed vehicle 3. The towing vehicle 2 may be, for example, an automobile (internal combustion engine automobile) using an internal combustion engine (engine, etc.) as a drive source, an automobile (electric automobile, fuel cell automobile, etc.) using an electric motor (motor, etc.) as a drive source, or an automobile (hybrid automobile) using both of these as drive sources. In addition, the type of vehicle is not limited, and as long as it is equipped with a towing device 4 described below, it may be a regular car or a large commercial tractor (trailer head).

[0013] As shown in Fig. 1, a towing device 4 (hitch) for towing a towed vehicle 3 is disposed so as to protrude from, for example, a lower part of the center part in the vehicle width direction of the rear bumper of the towing vehicle 2. Fig. 2 is an enlarged view showing the vicinity of the towing device 4 in particular.

[0014] As shown in Fig. 2, the towing device 4 is fixed to, for example, the frame of the towing vehicle 2. As an example, the towing device 4 is equipped with a hitch ball 5 that is erected vertically (in the up-down direction of the vehicle) and has a spherical tip, and this hitch ball 5 is covered by a coupler 7 provided at the tip of a connecting member 6 fixed to the towed vehicle 3, thereby connecting the hitch ball 5 and the coupler 7, and as a result, the towing vehicle 2 and the towed vehicle 3 are connected. However, the shapes of the hitch ball 5 and the coupler 7 are not limited to those shown in Fig. 2, and any shape may be used as long as the towing vehicle 2 and the towed vehicle 3 can be connected to each other.

[0015] When the hitch ball 5 and coupler 7 are connected, the hitch ball 5 transmits forward / backward and left / right movement to the towed vehicle 3 (connecting member 6) in accordance with the movement of the towing vehicle 2. Also, as shown in Figure 3, even when the coupler 7 is connected to the hitch ball 5, the angle of the coupler 7 relative to the hitch ball 5 can be freely displaced (however, there is an upper limit), and the towed vehicle 3 can swing (turn) in the vehicle width direction relative to the towing vehicle 2.

[0016] Meanwhile, as shown in Fig. 1, a rear camera (imaging device) 9 is installed on the wall of the rear hatch on the rear side of the towing vehicle 2. The rear camera 9 is, for example, a digital camera incorporating an imaging element such as a CCD or CIS. The rear camera 9 can output video data (captured image data) at a predetermined frame rate. The rear camera 9 has a wide-angle lens or a fisheye lens, the optical axis of which is set to face diagonally downward, and can capture images in a range of, for example, 140° to 220° in the horizontal direction.

[0017] The imaging range of the rear camera 9 includes at least the towing device 4 and hitch ball 5 at the rear end of the towing vehicle 2. The image data captured by the rear camera 9 can be used, for example, to detect the connection state between the towing vehicle 2 and the towed vehicle 3 (for example, the connection angle (hitch angle), whether they are connected, etc.). However, instead of the rear camera 9, a sensor installed on the towing device 4 may be used as a means for detecting the connection state between the towing vehicle 2 and the towed vehicle 3.

[0018] As shown in FIG. 1, an obstacle sensor 10 is installed on each of the left and right side mirrors of the towing vehicle 2. The obstacle sensor 10 is, for example, an ultrasonic sensor, and is basically composed of an ultrasonic transmitter and an ultrasonic receiver. The ultrasonic transmitter emits ultrasonic waves in the left and right directions of the towing vehicle 2, and the ultrasonic receiver receives the reflected waves reflected by obstacles (specifically, parked vehicles, block walls, etc.). As a result, it is possible to detect obstacles located around the towing vehicle 2 and the towed vehicle 3 based on the time from the emission of the ultrasonic waves to the reception of the reflected waves. In this embodiment, the presence or absence of an obstacle that affects parking and, if present, the distance from the towed vehicle 3 to the obstacle are detected based on the detection result of the obstacle sensor 10. However, instead of the obstacle sensor 10, a camera with an optical axis direction set to the side may be used as a means for detecting the obstacle. The obstacle sensor 10 may be installed on the towed vehicle 3 instead of the towing vehicle 2.

[0019] On the other hand, the towed vehicle 3 is also called a trailer, and travels while being towed by the towing vehicle 2. Therefore, unlike the towing vehicle 2, it basically does not have an engine or motor as a drive source. It also does not have a steering device (steering system) for changing the direction of the wheels. For example, a camper trailer with a living space inside, or a light trailer for carrying a car or boat, etc., falls into this category. The towed vehicle 3 comprises a main body, multiple trailer wheels (two in this embodiment), a connecting member 6, and a coupler 7.

[0020] Here, as shown in FIG. 1, the connecting member 6 is provided at the lower part of the center in the vehicle width direction of the main body of the towed vehicle 3, and is arranged so as to protrude forward (in the direction of travel) from the front end of the main body.

[0021] 2, the coupler 7 is provided at the front end of the connecting member 6, and is formed with a spherical recess that covers the hitch ball 5. When the coupler 7 covers the hitch ball 5, the towed vehicle 3 is rotatably connected to the towing vehicle 2 as described above (see FIG. 3). The length of the connecting member 6 and its height from the ground surface (i.e., the position of the coupler 7 on the towed vehicle 3) vary depending on the type of towed vehicle 3. However, in this embodiment, the coupler 7 is positioned at a position where it can be connected to at least the hitch ball 5 provided on the towing vehicle 2.

[0022] Next, we will explain the parking assistance device 1 equipped in the towing vehicle 2. The parking assistance device 1 is a device that assists the driver in operating the vehicle when parking the towing vehicle 2, coupled with the towed vehicle 3, into a specified parking space. Figure 4 is a block diagram showing the configuration of the parking assistance device 1 according to this embodiment.

[0023] 4, the parking assistance device 1 according to this embodiment includes an operation unit 14 that receives operations from an occupant of the towing vehicle 2, a liquid crystal display 15 that displays to the occupant of the towing vehicle 2 a driving trajectory for parking into a parking space and other information related to parking assistance, a speaker 16 that outputs audio guidance related to parking assistance, a vehicle information DB 21 in which various data related to the towing vehicle 2 and the towed vehicle 3 are recorded, and a parking assistance ECU 23 that performs various calculation processes based on the input information. In addition, the parking assistance device 1 is also connected to various sensors such as a rear camera 9 and an obstacle sensor 10 installed on the towing vehicle 2, a vehicle control ECU 24 that performs various controls on the towing vehicle 2, a vehicle speed sensor 25, a steering sensor 26, a shift position sensor 27, etc., via an in-vehicle network such as CAN.

[0024] The operation unit 14 is provided on the instrument panel or steering wheel of the towing vehicle 2, and has a plurality of operation switches (not shown) such as various keys and buttons which are operated, for example, when switching to a parking assistance mode described below, when inputting various parameters related to the towing vehicle 2 and the towed vehicle 3, etc. The parking assistance ECU 23 controls the execution of various corresponding operations based on switch signals output by pressing each switch, etc. The operation unit 14 may have a touch panel provided on the front surface of the liquid crystal display 15, and may also have a microphone and a voice recognition device.

[0025] The liquid crystal display 15 is provided on the instrument panel of the towing vehicle 2, and displays the driving trajectory for parking when switching to a parking assistance mode that assists in parking when the towing vehicle 2 is coupled to the towed vehicle 3. In addition, in cases where parking operations are performed by the user rather than automatically, steering operation instructions for driving along the driving trajectory and instructions for operating the brake, accelerator, and shift position are also displayed. The liquid crystal display 15 may also be used as a navigation device.

[0026] The speaker 16 also outputs voice guidance or the like that guides the parking operation when the vehicle is shifted to the parking assist mode based on an instruction from the parking assist ECU 23. The speaker 16 may also be used as a speaker for a navigation device.

[0027] The vehicle information DB 21 is a storage means for storing various information related to the towing vehicle 2 and the towed vehicle 3. For example, the installation position of the hitch ball 5 of the towing vehicle 2 (height from the ground surface, position in the left and right direction, distance from the rear end of the vehicle), overall length, vehicle width, wheelbase, minimum turning radius, etc. are stored. Also, the distance from the rear axle of the towing vehicle 2 to the connection point between the towing vehicle 2 and the towed vehicle 3 (position of the hitch ball 5) is stored. Meanwhile, the installation position of the coupler 7 of the towed vehicle 3 (height from the ground surface, position in the left and right direction, distance from the front end of the vehicle), overall length, vehicle width, minimum turning radius, etc. are stored. The distance from the rotation center of the towed vehicle 3 to the connection point between the towing vehicle 2 and the towed vehicle 3 (position of the hitch ball 5) (corresponding to the trailer wheelbase) is also stored. Incidentally, when the towed vehicle 3 has one axle (two wheels), the axle center is the rotation center of the towed vehicle 3. On the other hand, if the towed vehicle 3 has two axles (four wheels), the center of rotation is between the two axles. This information may be input in advance by a passenger or a person from the vehicle manufacturer using the operation unit 14, or values ​​detected by the rear camera 9 or various sensors may be input automatically. Since the towed vehicle 3 to be towed is not necessarily fixed, the above parameters must be changed if the towed vehicle 3 to be towed changes. A memory card, for example, can be used as a storage medium for the vehicle information DB 21. Furthermore, it may be provided in a storage area (for example, RAM or flash memory) within the parking assistance ECU 23.

[0028] On the other hand, the parking assist ECU (electronic control unit) 23 is an electronic control unit that controls the parking assist device 1 as a whole, and includes internal storage devices such as a CPU 31 as a calculation device and a control device, a RAM 32 that is used as a working memory when the CPU 31 performs various calculation processes and stores route data when a route is searched, a ROM 33 in which a parking assist program (see FIG. 5) described below and the like are recorded, and a flash memory 34 that stores a program read from the ROM 33. The parking assist ECU 23 has various control units as processing algorithms. For example, the parking start position acquisition unit acquires the parking start position. The parking target position acquisition unit acquires the parking target position. The travel trajectory generation unit generates a travel trajectory from the parking start position to the parking target position. The obstacle detection unit detects an obstacle on the side of the parking target position side of the towed vehicle 3 at the parking start position as an obstacle that will affect parking. The obstacle information acquisition unit acquires the position of the obstacle relative to the towed vehicle 3 at the parking start position or the distance to the obstacle.

[0029] The vehicle control ECU 24 is an electronic control unit that controls the towing vehicle 2. The vehicle control ECU 24 is connected to each driving part of the vehicle, such as the steering, brake, accelerator, and transmission. In this embodiment, for example, when switching to a parking assistance mode that assists parking in a parking space, which will be described later, the vehicle control ECU 24 can control each driving part to perform automatic driving assistance for the towing vehicle 2. Specifically, when the parking assistance mode is executed, the parking assistance ECU 23 transmits various types of assistance information related to automatic driving assistance generated by the parking assistance device 1 to the vehicle control ECU 24 via the CAN. Then, the vehicle control ECU 24 performs automatic driving assistance after starting to drive using the received various types of assistance information. Examples of the assistance information include a recommended driving trajectory for the towing vehicle 2 and the towed vehicle 3, and information indicating the vehicle speed and steering angle when driving according to the driving trajectory. In the automatic driving assistance, only the steering operation may be performed automatically, or the drive source, brake, and transmission may also be controlled automatically. On the other hand, the towing vehicle 2 does not necessarily need to be equipped with the automatic driving assistance, and the towing vehicle 2 may be a vehicle that can only be driven manually. In that case, when switching to the parking assistance mode, instead of the above-mentioned automatic driving assistance, steering operation guidance, brake, accelerator, and shift position operation guidance are provided to drive along the recommended driving trajectory.

[0030] Furthermore, the vehicle speed sensor 25 is made up of an active wheel speed sensor attached to the wheels of the towing vehicle 2, and detects the rotation speed of the wheels and outputs a speed signal. Furthermore, the steering sensor 26 is attached inside the steering device, and detects the steering angle when the steering wheel is turned, and outputs a steering angle signal. Furthermore, the shift position sensor 27 is built into the shift lever, and detects whether the shift position is "P (parking)", "N (neutral)", "R (reverse)", "D (drive)", "2 (second gear)", or "L (low)".

[0031] The parking assist ECU 23 is able to obtain the current vehicle speed, travel distance, steering angle, shift position, and the like of the towing vehicle 2 based on output signals from the various sensors described above.

[0032] Next, the parking assist processing program executed by the parking assist ECU 23 in the parking assist device 1 having the above configuration will be described with reference to Fig. 5. Fig. 5 is a flowchart of the parking assist processing program according to this embodiment. Here, the parking assist processing program is executed when the driver of the towing vehicle 2 operates the operation unit 14 to select transition to the parking assist mode after the ACC power supply (accessory power supply) of the towing vehicle 2 is turned on, and is a program that assists the driver in parking operations when parking the towing vehicle 2 with the towed vehicle 3 coupled thereto. The program shown in the flowchart in Fig. 5 below is stored in the RAM 32 and ROM 33 provided in the parking assist device 1, and is executed by the CPU 31.

[0033] First, in step (hereinafter abbreviated as S) 1, the CPU 31 acquires the parking start position and the parking target position. Basically, the current positions of the towing vehicle 2 and the towed vehicle 3 become the parking start position, but if it is difficult to park from the current positions to the parking target position, the parking start position may be set to a position different from the current position, and the vehicle may be guided to the parking start position. On the other hand, for the parking target position, for example, the user may specify a desired parking position from an image of the towing vehicle 2's surroundings displayed on the liquid crystal display 15, and the specified position may be set as the parking target position, or a parking space around the towing vehicle 2 may be detected by a camera or a sensor, and the detected parking space may be set as the parking target position.

[0034] Next, in S2, the CPU 31 detects obstacles around the towing vehicle 2 and the towed vehicle 3 by obtaining the detection results of the obstacle sensor 10. If an obstacle is detected, the position and shape of the detected obstacle are also identified from the detection results. As described above, the obstacle sensors 10 are installed on the left and right door mirrors of the towing vehicle 2 (see FIG. 1), and the detection range is set to include at least the left and right sides of the towing vehicle 2 and the towed vehicle 3. An imaging means such as a camera may be used to detect obstacles, and in this case, the type of obstacle can also be detected by performing image recognition on the captured image.

[0035] Next, in S3, the CPU 31 determines whether or not an obstacle that may have an effect on parking has been detected as a result of the obstacle detection in S2.

[0036] As explained in the prior art, when the towing vehicle 2 and towed vehicle 3 turn right (or left) from a straight line or a state close to it, it is known that the towed vehicle 3 swerves slightly in the opposite direction to the turning direction (see FIG. 12). Therefore, if there is an obstacle such as a wall on the side of the towed vehicle 3 at the parking start position on the side of the parking target position, there is a risk that the towed vehicle 3 will come into contact with the obstacle during the forward section up to the turning position (see FIG. 13).

[0037] Therefore, in S3, as shown in Fig. 6, an obstacle 41 on the side of the towed vehicle 3 at the parking start position S on the side of the parking target position G is determined to be an obstacle that will affect parking. The shape and size of the obstacle may be any that affects the running of the vehicle, and in this embodiment, the type of obstacle is not important. Other than walls, block walls, parked vehicles, buildings, etc. may also be used. However, it is also possible to limit the obstacles to specific types such as walls and other vehicles.

[0038] Then, if it is determined that an obstacle that may affect parking has been detected as a result of the obstacle detection in S2 (S3: YES), that is, if it is necessary to generate a driving trajectory for parking while taking the obstacle into consideration, the process proceeds to S4. On the other hand, if it is determined that an obstacle that may affect parking has not been detected (S3: NO), that is, if it is necessary to generate a driving trajectory for parking while taking the obstacle into consideration, the process proceeds to S11.

[0039] In S4, the CPU 31 acquires the distance L from the towed vehicle 3 to the influencing obstacle as information specifying the position of the obstacle (hereinafter referred to as the influencing obstacle) determined in S3 to have an influence on parking the towed vehicle 3 at the parking start position. Note that the distance L is calculated using, for example, the detection result of the obstacle sensor 10. Alternatively, if the influencing obstacle is an obstacle whose position is stored in the map information, the distance L can be acquired from the map information and the current position of the towed vehicle 3.

[0040] Next, in S5, the CPU 31 acquires the orientation of the towing vehicle 2 and towed vehicle 3 at the parking start position and the connection angle (hitch angle) between the towing vehicle 2 and towed vehicle 3. As described above, the current positions of the towing vehicle 2 and towed vehicle 3 basically become the parking start position, so in S5, the current orientation and connection angle of the towing vehicle 2 and towed vehicle 3 are acquired. The connection angle can be determined, for example, from an image captured by the rear camera 9.

[0041] Next, in S6, the CPU 31 obtains information on the towing vehicle 2 and the towed vehicle 3 from the vehicle information DB 21. The vehicle information DB 21 stores various information on the towing vehicle 2 and the towed vehicle 3, and in particular, in S6, at least the following information is obtained: "the distance from the rear wheel axle of the towing vehicle 2 to the connection point between the towing vehicle 2 and the towed vehicle 3 (the position of the hitch ball 5) (hereinafter referred to as the connection distance)" for the towing vehicle 2, and "the distance from the rotation center of the towed vehicle 3 to the connection point between the towing vehicle 2 and the towed vehicle 3 (the position of the hitch ball 5) (hereinafter referred to as the trailer wheel base)" for the towed vehicle 3.

[0042] Next, in S7, the CPU 31 generates a forward trajectory for the towing vehicle 2 to move forward from the parking start position. Here, the travel trajectory, particularly when performing reverse parking, has a forward section in which the vehicle moves forward once to a turning position appropriate for entering a parking target position such as a parking space, which is a parking target, and a reverse section in which the vehicle switches to reverse at the turning position and retreats to the parking target position. Hereinafter, the travel trajectory in the forward section is referred to as the forward trajectory, and the travel trajectory in the reverse section is referred to as the reverse trajectory. In S7, the forward trajectory most recommended for parking at the parking target position is generated without taking into consideration any influencing obstacles.

[0043] The method of generating the forward trajectory in S7 will be described below. First, the CPU 31 uses various information stored in the vehicle information DB 21 to calculate a recommended reverse trajectory for reverse parking into the parking target position, identifies the start point of the reverse trajectory (the position where reverse starts) as the turning position, and obtains the orientation of the towing vehicle 2 and the towed vehicle 3 at the turning position as the turning orientation. The reverse trajectory is basically calculated with a priority on shortening the route length, and such that the maximum curvature and the rate of change of the curvature do not exceed thresholds that allow safe travel. In addition, a reverse turning operation to increase the curvature of the travel trajectory drawn by the towed vehicle 3 and a further turning operation to reduce the curvature thereafter may also be performed.

[0044] Thereafter, the CPU 31 starts moving from the parking start position in the direction of the towing vehicle 2 acquired in S5, calculates a forward trajectory of the towing vehicle 2 for the towing vehicle 2 and the towed vehicle 3 to reach the specified turning position in the same specified turning direction, and generates the calculated forward trajectory as the most recommended forward trajectory for parking at the parking target position. For example, the forward trajectory 42 of the towing vehicle 2 generated in S7 is a trajectory in which the towing vehicle 2 advances while turning from the parking start position S in a direction away from the parking target position G, as shown in FIG. 7. More specifically, the forward trajectory 42 is a combination of a first clothoid curve that advances while gradually turning the steering wheel to the right from the parking start position S (i.e., while the curvature gradually changes to a large value) and a second clothoid curve that advances while gradually returning the steering wheel to a straight direction (i.e., while the curvature gradually changes to a small value). However, the forward trajectory 42 is not limited to the shape shown in FIG. 7 as long as it is a route that can reach the specified turning position in the same specified turning direction. The forward trajectory generated in S7 is hereinafter also referred to as the reference trajectory.

[0045] Thereafter, in S8, the CPU 31 predicts the travel trajectory of the towed vehicle 3 when the towing vehicle 2 moves according to the forward trajectory generated in S7, and acquires the predicted travel trajectory as the forward trajectory of the towed vehicle 3. The prediction of the travel trajectory of the towed vehicle 3 is performed based on the trailer wheel base and connection distance acquired in S6, and the orientation and connection angle of the towed vehicle 3 at the parking start position acquired in S5. Figure 7 also shows an example of a forward trajectory 43 of the towed vehicle 3 predicted when the towing vehicle 2 moves according to the forward trajectory 42.

[0046] Next, in S9, the CPU 31 calculates the amount of bulge X when the towed vehicle 3 travels along the forward trajectory predicted in S8. The amount of bulge X here defines the amount by which the towed vehicle 3 slightly bulges in the direction opposite to the turning direction when the towing vehicle 2 travelling along the forward trajectory generated in S7 turns as shown in Fig. 8, and is the distance by which the towed vehicle 3 bulges outward from the parking start position along the vehicle width direction as shown in Fig. 8. The amount of bulge X also depends on the magnitude of the curvature of the forward trajectory, the coupling distance, and the trailer wheelbase. That is, the greater the curvature of the forward trajectory, the greater the amount of bulge X, the longer the coupling distance, and the shorter the trailer wheelbase, the greater the amount of bulge X.

[0047] Next, in S10, the CPU 31 determines whether the forward trajectory of the towed vehicle 3 predicted in S8 overlaps with an influencing obstacle. In S10, "the forward trajectory of the towed vehicle 3 overlaps with the influencing obstacle" refers to not only the case where the area where the influencing obstacle is located overlaps with the forward trajectory of the towed vehicle 3, but also the case where the area where the influencing obstacle is located overlaps with the towed vehicle 3 when the towed vehicle 3 travels along the forward trajectory, i.e., the bulge amount X becomes larger than the distance L to the influencing obstacle.

[0048] If it is determined that the forward trajectory of the towed vehicle 3 predicted in S8 overlaps with the affecting obstacle (S10: YES), i.e., if it is determined that there is a risk that the towed vehicle 3 will come into contact with the affecting obstacle if the towing vehicle 2 travels along the forward trajectory (reference trajectory) generated in S7, the process proceeds to S12. On the other hand, if it is determined that the forward trajectory of the towed vehicle 3 predicted in S8 does not overlap with the affecting obstacle (S10: NO), i.e., if it is determined that there is no risk that the towed vehicle 3 will come into contact with the affecting obstacle even if the towing vehicle 2 travels along the forward trajectory (reference trajectory) generated in S7, the process proceeds to S11.

[0049] In S11, the CPU 31 outputs a combination of the forward trajectory generated in S7 (if S3:NO, the process of S7 is additionally executed) and a reverse trajectory reversing from a turning position on the forward trajectory (specifically, the end point) as a recommended driving trajectory from the parking start position to the parking target position. Note that the calculation of the reverse trajectory reversing from the turning position has already been explained in S7, so an explanation is omitted. Note that guidance and control based on the driving trajectory are performed based on the driving trajectory of the towing vehicle 2, so only the driving trajectory of the towing vehicle 2 may be output in S11.

[0050] Meanwhile, in S12, the CPU 31 newly generates a plurality of candidates (hereinafter referred to as forward trajectory candidates) with different curvatures during turning as candidates for the forward trajectory of the towing vehicle 2 to replace the forward trajectory (reference trajectory) generated in S7. Basically, the smaller the curvature during turning, the smaller the bulge amount X becomes, so a trajectory with a smaller curvature during turning than the reference trajectory is generated as the forward trajectory candidate. Furthermore, when generating a plurality of forward trajectory candidates, it is preferable to generate a plurality of candidates with curvatures that are gradually reduced. For example, the first forward trajectory candidate has a curvature that is 20% smaller than the reference trajectory, and the second forward trajectory candidate has a curvature that is 40% smaller than the reference trajectory.

[0051] On the other hand, if the traveling direction of the towing vehicle 2 at the parking start position S is the x-axis direction, and the horizontal direction perpendicular to the traveling direction is the y-axis direction as shown in Fig. 9, the end point of the forward trajectory candidate generated in S12 is significantly displaced in the x-axis direction compared to the reference trajectory. Note that, although only two forward trajectory candidates are generated in the example shown in Fig. 9, only one or three or more forward trajectory candidates may be generated.

[0052] In addition, when the curvature during turning is made smaller than that of the reference trajectory, it is also possible to make the curvature of the turning trajectory smaller only in the range where the distance to the influencing obstacle is particularly close (i.e., immediately after starting traveling) rather than making the curvature of the entire trajectory smaller than that of the reference trajectory. Also, it is possible to make the curvature larger than that of the reference trajectory in the range where the distance to the influencing obstacle is farther away (i.e., when approaching the turning position).

[0053] Thereafter, in S13, the CPU 31 predicts the traveling trajectory of the towed vehicle 3 when the towing vehicle 2 moves according to each of the forward trajectory candidates generated in S12, and acquires the predicted traveling trajectory as the forward trajectory candidate of the towed vehicle 3. Note that the method of predicting the traveling trajectory of the towed vehicle 3 is the same as in S8, and therefore the explanation will be omitted.

[0054] Next, in S14, the CPU 31 calculates the amount of bulge X when the towed vehicle 3 travels according to each of the forward trajectory candidates predicted in S13. Note that the method of calculating the amount of bulge X is the same as that in S9, and therefore the explanation will be omitted.

[0055] Next, in S15, the CPU 31 selects the forward trajectory candidate of the towed vehicle 3 predicted in S13 that does not overlap with the influencing obstacle and has the shortest route length. Specifically, for a forward trajectory candidate in which the bulge amount X calculated in S14 is smaller than the distance L to the influencing obstacle, it is deemed that the forward trajectory candidate of the towed vehicle 3 does not overlap with the influencing obstacle. In addition, the route length may be compared using the length of the forward trajectory candidate of the corresponding towing vehicle 2 instead of the forward trajectory candidate of the towed vehicle 3. Note that, if any of the forward trajectory candidates of the towed vehicle 3 predicted in S13 overlap with the influencing obstacle, it is preferable to return to S12 and generate a new candidate with a smaller curvature during turning.

[0056] Thereafter, in S16, the CPU 31 compares the forward trajectory candidate of the towing vehicle 2 corresponding to the forward trajectory candidate of the towed vehicle 3 selected in S15 among the forward trajectory candidates generated in S12 (hereinafter referred to as the selected candidate) with the forward trajectory (reference trajectory) generated in S7, and calculates the difference in length in the x-axis direction (which also corresponds to the distance between the end points) when the vehicle traveling direction of the towing vehicle 2 at the parking start position S is the x-axis direction as shown in Fig. 9 as an initial reverse distance D. For example, in the example shown in Fig. 9, if the selected candidate is the forward trajectory candidate 51, the initial reverse distance D is D1, and if the selected candidate is the forward trajectory candidate 52, the initial reverse distance D is D2.

[0057] Here, the initial reverse distance D calculated in S16 is the shortest distance by which the parking start position needs to be moved backward in order to position the turning position on the forward trajectory that allows the vehicle to reverse to the parking target position. The reason for this will be explained below. As described above, the end point of the forward trajectory candidate generated in S12 is significantly displaced in the x-axis direction compared to the reference trajectory, so that in the case where the selected candidate is the forward trajectory candidate 51 as shown in Fig. 10, if the movement start position of the forward trajectory candidate 51 is moved backward from the parking start position by the initial reverse distance D, the end point of the reference trajectory 42 and the forward trajectory candidate 51 in the x-axis direction will coincide. Also, if the movement start position of the forward trajectory candidate 51 is moved backward from the parking start position by the initial reverse distance D, the turning position can be set at a position where the generation of the reverse trajectory is possible.

[0058] Next, in S17, the CPU 31 generates an initial reverse trajectory for reversing backward in a straight line from the parking start position acquired in S1 by an initial reverse distance D. Furthermore, a reverse trajectory for reversing to the parking target position after turning at the end point of the selected trajectory is also generated. Note that the reverse trajectory can be calculated in the same way as the reverse trajectory for the reference trajectory generated in S7, so a description thereof will be omitted.

[0059] Thereafter, in S18, the CPU 31 outputs a combination of the initial reverse trajectory generated in S17, the reverse trajectory also generated in S17, and the selected candidate (the forward trajectory candidate of the towing vehicle 2 corresponding to the forward trajectory candidate of the towed vehicle 3 selected in S15) as a recommended travel trajectory from the parking start position to the parking target position. As a result, as shown in FIG. 11, the travel trajectory finally output is a trajectory that travels in order of an initial reverse trajectory 55 that reverses backward by an initial reverse distance D in a straight line direction from the parking start position acquired in S1 to adjust the parking start position, a corrected forward trajectory 56 that is a selected candidate trajectory that advances with the adjusted parking start position as the travel start position, and a reverse trajectory 57 that reverses to the parking target position after turning around on the corrected forward trajectory 56 (specifically, the end point). Note that the corrected forward trajectory 56 is a travel trajectory that satisfies the condition that the travel trajectory of the towed vehicle 3 does not overlap with an influencing obstacle, so that a travel trajectory that is impossible to travel due to an influencing obstacle is not generated in S18. In addition, it is possible to generate a travel trajectory that prioritizes the shortest possible route length within a range that satisfies the condition of not overlapping with influencing obstacles. Since guidance and control based on the travel trajectory are performed based on the travel trajectory of the towing vehicle 2, only the travel trajectory of the towing vehicle 2 may be output in S18.

[0060] In this embodiment, the initial reverse distance D, which is the length of the initial reverse trajectory 55, is set to the difference in the length in the x direction between the selected candidate and the reference trajectory, but the initial reverse distance D may be greater than the difference in the length in the x direction between the selected candidate and the reference trajectory. In other words, the initial reverse distance D may be set to a trajectory in which the vehicle is reversed a little more with a margin. In that case, if the timing of turning after starting to move forward on the corrected forward trajectory 56 is delayed, it is possible to position a turning position on the corrected forward trajectory 56 that allows the vehicle to move backward to the parking target position. However, if priority is given to shortening the path length as much as possible, it is preferable that the initial reverse distance D is set to the difference in the length in the x direction between the selected candidate and the reference trajectory (i.e., the shortest distance that the parking start position needs to be moved backward to position a turning position on the forward trajectory that allows the vehicle to move backward to the parking target position).

[0061] The parking assistance device 1 can then control each drive unit based on the travel trajectory output in S18 to provide parking assistance for the towing vehicle 2. Specifically, the parking assistance device 1 transmits various assistance information related to automatic driving assistance, such as the travel trajectory generated in S18, to the vehicle control ECU 24 via the CAN. The vehicle control ECU 24 then uses the received various assistance information to provide automatic driving assistance. Specifically, the vehicle control ECU 24 controls the steering, drive source, brakes, and transmission so that the towing vehicle 2 moves from the parking start position to the parking target position along the travel trajectory generated in S18. Note that the automatic driving assistance may be such that only the steering operation is performed automatically, and the accelerator, brake, and shift position operations are performed manually. On the other hand, the towing vehicle 2 does not necessarily need to be equipped with the automatic driving assistance, and the towing vehicle 2 may be a vehicle that can only be driven manually. In that case, instead of the automatic driving assistance, the vehicle control ECU 2 provides operation guidance for the steering, brakes, accelerator, and shift position to travel along the travel trajectory generated in S18.

[0062] During the transition to the parking assistance mode, in order to allow the driver to check whether the parking operation is being performed according to the generated travel trajectory, it is desirable to display the travel trajectory and the current position of the vehicle in a comparable state on the liquid crystal display 15. Furthermore, an overhead image looking down from above may be generated based on surrounding images captured by cameras installed on the towing vehicle 2 and the towed vehicle 3, and the overhead image may be displayed on the liquid crystal display 15 during the transition to the parking assistance mode.

[0063] As described above in detail, according to the parking assistance device 1 and the computer program executed by the parking assistance device 1 of this embodiment, the parking start position and the parking target position are acquired (S1), and when generating a driving trajectory from the parking start position to the parking target position, an obstacle on the side of the towed vehicle 3 at the parking start position on the side of the parking target position is detected as an obstacle that will affect parking (S2), the position of the obstacle relative to the towed vehicle 3 at the parking start position or the distance to the obstacle is acquired (S4), and based on the position of the obstacle relative to the towed vehicle 3 at the parking start position or the distance to the obstacle, it is determined whether or not the driving trajectory of the towed vehicle 3 satisfies the condition of not overlapping with the obstacle, and a driving trajectory of the forward section is generated so that the path length is shortened to the extent that the condition is satisfied (S12 to S18), so that a driving trajectory that is impossible to drive due to an obstacle is not generated, and a more appropriate driving trajectory can be generated. In addition, the trailer wheel base, which is the distance from the rotation center of the towed vehicle to the connection point between the towing vehicle and the towed vehicle, and the connection distance, which is the distance from the rear axle of the towing vehicle 2 to the connection point between the towing vehicle 2 and the towed vehicle 3, are obtained (S6). A plurality of candidates with different curvatures when turning are generated as candidates for the driving trajectory of the towing vehicle 2 in the forward section (S12). For each of the plurality of candidates, the driving trajectory of the towed vehicle 3 when the towing vehicle 2 travels on that candidate is calculated based on the trailer wheel base and the connection distance (S13). Of the candidates where the calculated driving trajectory of the towed vehicle 3 does not overlap with any obstacles, the candidate with the shortest route length is selected and generated as the driving trajectory for the forward section (S15). This makes it possible to generate a driving trajectory for the forward section that does not overlap with any obstacles. In addition, a reference trajectory, which is the driving trajectory for the forward section without taking obstacles into consideration, is obtained (S7), and if the reference trajectory satisfies the condition of not overlapping with an obstacle, the reference trajectory is generated as the driving trajectory for the forward section, while if the reference trajectory does not satisfy the condition of not overlapping with an obstacle, multiple candidates for the driving trajectory of the towing vehicle 2 in the forward section, which have a smaller curvature when turning than the reference trajectory, are generated.Therefore, in a situation where there is no risk of overlapping with an obstacle, it is possible to generate a recommended driving trajectory without taking obstacles into consideration, while in a situation where there is a risk of overlapping with an obstacle, it is possible to adjust the curvature of the driving trajectory to generate a driving trajectory that does not overlap with an obstacle. In addition to the forward section and reverse section, the driving trajectory further includes an initial reverse section in which the parking start position is adjusted by reversing backward a predetermined distance in a straight line direction from the parking start position, and the predetermined distance is the shortest distance that the parking start position needs to be moved backward in order to position a turning point that allows the vehicle to revert to the parking target position on the driving trajectory of the forward section. Therefore, even if the curvature of the driving trajectory is changed by adjusting the parking start position, it is possible to position the turning point that allows the vehicle to revert to the parking target position on the driving trajectory of the forward section.

[0064] Incidentally, the present invention is not limited to the above-described embodiment, and it is needless to say that various improvements and modifications are possible without departing from the spirit and scope of the present invention. For example, in this embodiment, even if the curvature of the forward trajectory is changed to be smaller, an initial reverse section is added in which the vehicle retreats a predetermined distance backward in a straight line from the parking start position, so that a turning position allowing the vehicle to retreat to the parking target position is located on the forward trajectory, but it is also possible to locate a turning position allowing the vehicle to retreat to the parking target position on the forward trajectory without adding an initial reverse section. For example, it is also possible to limit the range in which the curvature of the forward trajectory is changed to be smaller to a range close to the influencing obstacle, and conversely, to increase the curvature in a range away from the influencing obstacle, so that a turning position allowing the vehicle to retreat to the parking target position is located on the forward trajectory.

[0065] In this embodiment, the position of an obstacle is detected by the obstacle sensor 10, but the position of the obstacle may be detected by performing image recognition processing on an image captured by a camera set with its optical axis oriented to the side. Furthermore, a database (e.g., map information) that stores the positions and shapes of obstacles may be provided, and the position of the obstacle may be calculated by referring to the position of the towing vehicle 2 and the database.

[0066] In this embodiment, the distance L from the towed vehicle 3 to the obstacle is acquired as information for identifying the position of the obstacle relative to the towed vehicle 3 at the parking start position in S4, and the distance L is used to perform the determination process in S10. However, in addition to the distance L from the towed vehicle 3 to the obstacle, the direction of the obstacle from the towed vehicle 3 may be identified and the direction may also be used to perform the determination process in S10. Alternatively, the specific position coordinates of the obstacle (relative coordinates with respect to the towed vehicle 3) may also be identified from the distance L and the direction. Then, the determination process in S10 may be performed using the specific position coordinates instead of the distance L. If a camera or the like is used as a means for detecting the obstacle, it is also possible to directly identify the specific position coordinates of the obstacle instead of the distance L and the direction.

[0067] In addition, the forward trajectory candidate generated in S12 may have a different turning timing rather than a smaller curvature than the reference trajectory, as long as overlap with an influencing obstacle can be avoided by changing the turning timing.

[0068] In this embodiment, the forward trajectory candidate is generated by reducing the curvature compared to the reference trajectory, but it is also possible to adjust the rudder angle (steering angle) during traveling instead of the curvature. Note that the curvature of the traveling trajectory of the towing vehicle 2 and the rudder angle of the towing vehicle 2 traveling along the traveling trajectory are basically linked, so there is no problem in adjusting the rudder angle instead of the curvature.

[0069] In this embodiment, the parking assistance processing program (FIG. 5) is executed by the parking assistance ECU 23 of the parking assistance device 1, but the executing entity can be changed as appropriate. For example, the processing may be executed by the control unit of the liquid crystal display 15, the vehicle control ECU, the control unit of the navigation device, or other in-vehicle device. [Explanation of symbols]

[0070] 1...parking assistance device, 2...towing vehicle, 3...towed vehicle, 4...towing device, 5...hitch ball, 6...connecting member, 7...coupler, 9...rear camera, 15...liquid crystal display, 31...CPU, 32...RAM, 33...ROM, 41...obstacle, 42...reference trajectory (recommended forward trajectory when obstacles are not taken into consideration), 51, 52...forward trajectory candidates, 55...initial reverse trajectory, 56...corrected forward trajectory, 57...reverse trajectory

Claims

1. A parking assistance device that assists in parking a towing vehicle and a towed vehicle that is to be towed by the towing vehicle in a state in which the towing vehicle and the towed vehicle are coupled together, comprising: a parking start position acquisition unit for acquiring a parking start position; A parking target position acquisition unit that acquires a parking target position; a travel trajectory generating unit that generates a travel trajectory from the parking start position to the parking target position; an obstacle detection unit that detects an obstacle on the side of the towed vehicle at the parking start position on the side of the parking target position as an obstacle that may affect parking; an obstacle information acquisition unit that acquires a position of the obstacle or a distance to the obstacle with respect to the towed vehicle that is located at the parking start position, the travel path includes a forward section in which the vehicle travels forward from the parking start position while turning in a direction away from the parking target position, and a reverse section in which the vehicle travels backward to the parking target position after turning around on the travel path of the forward section, The running trajectory generation unit determining whether or not a travel path of the towed vehicle satisfies a condition that the travel path does not overlap with the obstacle based on a position of the obstacle relative to the towed vehicle at the parking start position or a distance to the obstacle; A parking assistance device that generates a driving trajectory for the forward section so as to shorten the path length within a range that satisfies the condition.

2. a trailer wheelbase acquisition unit that acquires a distance from a rotation center of the towed vehicle to a connection point between the towing vehicle and the towed vehicle as a trailer wheelbase; a coupling distance acquisition unit that acquires a coupling distance that is a distance from a rear wheel axle of the towing vehicle to the coupling point, The running trajectory generation unit generating a plurality of candidates for a travel trajectory of the towing vehicle in the forward section, the candidates having different curvatures when turning; calculating a travel trajectory of the towed vehicle when the towing vehicle travels on each of the plurality of candidates based on the trailer wheel base and the coupling distance; 2. The parking assistance device according to claim 1, wherein a candidate with the shortest route length is selected from among the candidates in which the calculated travel trajectory of the towed vehicle does not overlap with the obstacle, and the selected candidate is generated as the travel trajectory of the forward section.

3. The running trajectory generation unit obtain a reference trajectory, which is a travel trajectory of the forward section that does not take into account the obstacle; If the reference trajectory satisfies the condition, the reference trajectory is generated as a running trajectory of the forward section; 3. The parking assistance device according to claim 2, wherein when the reference trajectory does not satisfy the condition, the plurality of candidates for the driving trajectory of the towing vehicle in the forward section are generated with a smaller curvature during turning than the reference trajectory.

4. In addition to the forward section and the reverse section, the travel path further includes an initial reverse section in which the vehicle is reversed backward from the parking start position by a predetermined distance in a straight line direction to adjust the parking start position, 4. The parking assistance device according to claim 1, wherein the predetermined distance is the shortest distance by which the parking start position needs to be moved backward in order to position a turning position that allows the vehicle to move backward to the parking target position on a travel path of the forward section.

Citation Information

Patent Citations

  • Assistance system for maneuvering a vehicle combination and methods for operating such an assistance system

    DE102014013219A1

  • Parking support system

    JP2014091492A

  • Parking assistance system

    JP2021054148A

  • Parking route generating device and parking control device

    JP2022107175A

  • Parking route generating device

    JP2023044216A