Parking assistance device
The parking assist device addresses the issue of unfeasible paths in towing vehicle systems by calculating recommended curvature and slope values for towed vehicles, ensuring a feasible and efficient parking trajectory.
Patent Information
- Application Number
- JP2023073197
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-04-27
- Publication Date
- 2024-11-08
AI Technical Summary
Existing parking assistance systems for towing vehicles fail to consider the gradient of curvature in the traveling trajectory of towed vehicles, leading to the risk of setting false paths that cannot be followed during parking, especially in reverse cutting and additional cutting operations.
A parking assist device that calculates a more appropriate travel trajectory for towing and towed vehicles by specifying recommended values for maximum curvature and slope, considering the trailer wheelbase and connection distance to ensure the curvature and steering angle do not exceed allowed limits, thereby preventing the towed vehicle from following an unfeasible path.
The device enables the calculation of a more suitable travel trajectory that can be followed without generating unfeasible paths, ensuring efficient and complete parking by adjusting the curvature and slope based on the towing vehicle's allowed curvature and steering angle limits.
Smart Images

Figure 2024158206000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a parking assistance device that assists in parking a vehicle. [Background technology]
[0002] Conventionally, a method for assisting a vehicle in parking is known in which a driving trajectory is calculated for parking, and guidance and vehicle control are performed so that the vehicle is parked according to the calculated driving trajectory. Here, when providing parking assistance to a towing vehicle (tractor) towing a towed vehicle (trailer), it is necessary to calculate the 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] Here, regarding the curvature of the running track drawn by the towing vehicle when the towing vehicle towing the towed vehicle is reversing, since the towed vehicle does not have a steering device, the curvature of the running track of the towed vehicle is determined mainly based on the connection angle (hitch angle) between the towing vehicle and the towed vehicle, as shown in Figure 7. That is, as shown in the upper diagram of Figure 7, when the connection angle between the towing vehicle 2 and the towed vehicle 3 is 0 degrees (positioned in a straight line), the curvature of the running track drawn by the towed vehicle 3 when pushed by the reversing towing vehicle 2 is 0. On the other hand, as shown in the lower diagram of Figure 7, if the connection angle between the towing vehicle 2 and the towed vehicle 3 becomes larger than 0 degrees, the curvature of the running track drawn by the towed vehicle 3 when pushed by the reversing towing vehicle 2 becomes larger than 0. And, the larger the connection angle between the towing vehicle 2 and the towed vehicle 3, the larger the curvature of the running track of the towed vehicle 3 (the smaller the turning radius).
[0006] Here, when the towing vehicle 2 towing the towed vehicle 3 reverses and parks, it is important to increase the curvature of the travel path drawn by the towed vehicle 3 in as short a time as possible in order to shorten the total length of the path required for parking. Therefore, as shown in Fig. 8, the towing vehicle 2 first performs a reverse steering operation to steer in the opposite direction (rightward in Fig. 8) to the original turning direction (leftward as seen from the driver in Fig. 8, since the driver wants to turn left rearward), immediately after starting to reverse, and then steers in the original turning direction. On the other hand, when approaching the parking target position, it is necessary to bring the connection angle between the towing vehicle 2 and the towed vehicle 3 closer to 0 degrees, but in order to shorten the total length of the path required for parking, it is effective to maintain the curvature as large as possible until the end, and then quickly reduce the curvature, rather than gradually reducing the curvature, so that an increase in steering in the turning direction is generally performed at the end of the turn.
[0007] In the above-mentioned Patent Document 1, the maximum value of the curvature of the target route of the towed vehicle is adjusted to be within an allowable range, but the gradient of the curvature (rate of change) is not taken into consideration at all. As a result, there is a risk that a target route that cannot be followed will be set in a section where the gradient of the curvature becomes large, such as when turning in the reverse direction or when turning further.
[0008] 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 calculate a more appropriate driving trajectory without generating a driving trajectory that is impossible to follow when parking, by specifying recommended values for the maximum curvature and gradient of the driving trajectory of the towed vehicle. [Means for solving the problem]
[0009] In order to achieve the above object, the parking assistance device of the present invention is a parking assistance device that assists in parking 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 the driving trajectory of the towed vehicle when parking includes a first section in which the towed vehicle reverses while increasing the curvature from an initial curvature at the start of reverse to a predetermined turning curvature, and a second section in which the towed vehicle reverses while decreasing the curvature from the predetermined turning curvature, and a maximum value setting section that sets a maximum value of the curvature or steering angle allowed for the driving trajectory of the towing vehicle ... from the rotation center of the towed vehicle. The towing vehicle has a trailer wheelbase acquisition unit that acquires the distance to the connection point between the towing vehicle and the towed vehicle as a trailer wheelbase, a connection distance acquisition unit that acquires a connection distance that is the distance from the rear wheel axle of the towing vehicle to the connection point between the towing vehicle and the towed vehicle, and a parameter identification unit that identifies recommended values for the specified turning curvature and the curvature gradient of the second section of the driving trajectory when the towed vehicle is parked based on the trailer wheelbase and the connection distance under the condition that the curvature or steering angle of the driving trajectory of the towing vehicle does not exceed the maximum value. Incidentally, the gradient may be the rate of change of the gradient per unit distance, or the rate of change of the gradient per unit time. Effect of the Invention
[0010] The parking assistance device according to the present invention having the above configuration can determine recommended values for the maximum curvature and gradient of the towed vehicle's travel path based on the trailer wheelbase and the distance from the rear wheel axle of the towing vehicle to the coupling point, while taking into consideration the maximum allowable curvature or steering angle of the towing vehicle's travel path. As a result, a travel path that cannot be followed during parking is not generated, and a more appropriate travel path can be calculated using the recommended values. [Brief description of the drawings]
[0011] [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] 5 is a flowchart of a parameter specifying processing program according to the present embodiment. [Figure 6] FIG. 13 is a diagram showing a hypothetical parking situation set for calculating recommended parameters. [Figure 7] 1 is a diagram showing the relationship between the connection angle and the curvature of the travel path traced by the towed vehicle. [Figure 8] 11A and 11B are diagrams illustrating a reverse turning operation and a further turning operation. [Figure 9] 1 is a diagram showing changes in the curvature of the travel trajectory of a towing vehicle and a towed vehicle during the process of reverse turning and further turning operations performed by the towing vehicle. FIG. [Figure 10] 1 is a diagram showing the relationship between the curvature of the towing vehicle's travel path and the turning curvature gradient α of the towed vehicle's travel path during reverse turning by the towing vehicle. FIG. [Figure 11] 1 is a diagram showing the relationship between the curvature of the towing vehicle's travel path and the return curvature gradient β of the towed vehicle's travel path during turning of the towing vehicle. FIG. [Figure 12]FIG. 13 is a diagram illustrating a method for calculating the total length of a route required for parking. [Figure 13] FIG. 13 is a diagram showing the relationship between the trailer wheel base and specified parameters. [Figure 14] 4 is a flowchart of a parking assistance processing program according to the embodiment. [Figure 15] FIG. 13 is a diagram showing an example of a forward trajectory from a parking start position. [Figure 16] FIG. 13 is a diagram showing candidate turning positions set on a forward trajectory. [Figure 17] FIG. 13 is a diagram showing the relationship between the initial curvature of a reverse trajectory and the connection angle at a turning position. [Figure 18] FIG. 13 is a diagram showing the relationship between the initial curvature of a reverse trajectory and the connection angle at a turning position. [Figure 19] FIG. 13 is a diagram showing an example of a reverse trajectory calculated for a candidate turning-back position; [Figure 20] FIG. 11 is a diagram comparing reverse trajectories calculated for a plurality of candidate turning-back positions; [Figure 21] 11A and 11B are diagrams illustrating a method of correcting a candidate turning-back position. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0012] 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.
[0013] 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).
[0014] 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.
[0015] 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.
[0016] 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.
[0017] 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.
[0018] 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.
[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 has an operation unit 14 that accepts operations from the 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 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, and a shift position sensor 27 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 also 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. Also, 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 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 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 that stores a parameter identification processing program (see FIG. 5) and a parking assist program (see FIG. 14) described later in addition to control programs, and a flash memory 34 that stores programs read from the ROM 33. The parking assist ECU 23 has various control units as processing algorithms. For example, the maximum value setting unit sets the maximum value of the curvature or steering angle allowed for the running path of the towing vehicle 2. The trailer wheelbase acquisition unit acquires the distance from the rotation center of the towed vehicle 3 to the coupling point between the towing vehicle 2 and the towed vehicle 3 as the trailer wheelbase. The coupling distance acquisition unit acquires the coupling distance, which is the distance from the rear wheel axle of the towing vehicle 2 to the coupling point between the towing vehicle 2 and the towed vehicle 3. The parameter specification unit specifies recommended values of a predetermined turning curvature X and a return curvature gradient β of the driving path of the towed vehicle 3 when parked, based on the trailer wheel base and the coupling distance, under the condition that the curvature or steering angle of the driving path of the towing vehicle 2 does not exceed a maximum value.
[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, a parameter identification processing program executed by the parking assistance ECU 23 in the parking assistance device 1 having the above configuration will be described with reference to Fig. 5. Fig. 5 is a flowchart of the parameter identification processing program according to this embodiment. Here, the parameter identification processing program is executed when a predetermined initial setting operation is received at the operation unit 14 with the ACC power supply (accessory power supply) of the towing vehicle 2 turned on, and is a program for deriving recommended values of parameters used to generate a driving trajectory when parking. The program shown in the flowchart in Fig. 5 below is stored in the RAM 32 and ROM 33 provided in the parking assistance device 1, and is executed by the CPU 31.
[0033] First, in step (hereinafter abbreviated as S) 1, the CPU 31 acquires information relating to the towing vehicle 2 and the towed vehicle 3 from the vehicle information DB 21. The vehicle information DB 21 stores various information relating to the towing vehicle 2 and the towed vehicle 3, and in particular, in S1, at least the "minimum turning radius" and the "distance from the rear axle of the towing vehicle 2 to the coupling point between the towing vehicle 2 and the towed vehicle 3 (position of the hitch ball 5) (hereinafter referred to as coupling distance)" for the towing vehicle 2, and the "distance from the coupling point between the towing vehicle 2 and the towed vehicle 3 to the front axle of the towed vehicle 3 (hereinafter referred to as trailer wheelbase)" for the towed vehicle 3 are acquired.
[0034] Next, in S2, the CPU 31 sets a virtual parking situation as shown in Fig. 6 in order to derive recommended parameter values. In particular, in S2, an arbitrary value is set as the approach angle Δθ into the parking space (corresponding to the angle required to turn in order to enter the parking space). The approach angle Δθ may be set to, for example, any of 30 degrees, 60 degrees, and 90 degrees. Also, a plurality of angles may be set as the approach angle Δθ, in which case the following process is executed for each set approach angle Δθ, and parameters are calculated for each Δθ.
[0035] Next, in S3, the CPU 31 sets a maximum curvature allowable for the travel trajectory of the towing vehicle 2 based on the minimum turning radius of the towing vehicle 2 acquired in S1. In particular, as the maximum curvature, a first maximum curvature allowable for the travel trajectory in which the towing vehicle 2 turns in the same direction as the towed vehicle 3 (in the example shown in FIG. 6, rightward along the backward direction) and a second maximum curvature allowable for the travel trajectory in which the towing vehicle 2 turns in a direction different from that of the towed vehicle 3 (in the example shown in FIG. 6, leftward along the backward direction) are set, and further, the second maximum curvature is set to a value smaller than the first maximum curvature. For example, the first maximum curvature is set to the curvature of the trajectory drawn when the towing vehicle 2 turns with the minimum turning radius, and the second maximum curvature is set to 3 / 4 of the first maximum curvature. As an example, the first maximum curvature is set to 0.2 [1 / m] and the second maximum curvature is set to 0.15 [1 / m].
[0036] After that, in S4, the CPU 31 sets the turning curvature of the towed vehicle 3 to an arbitrary value when parking is performed in the virtual parking situation set in S2. The turning curvature corresponds to the maximum value (maximum curvature) of the curvature of the traveling path of the towed vehicle 3.
[0037] Here, regarding the curvature of the running track drawn by the towing vehicle 3 when the towing vehicle 2 towing the towed vehicle 3 is reversing, since the towed vehicle 3 does not have a steering device, the curvature of the running track of the towed vehicle 3 is determined mainly based on the connection angle between the towing vehicle 2 and the towed vehicle 3 as shown in Figure 7. That is, as shown in the upper diagram of Figure 7, when the connection angle between the towing vehicle 2 and the towed vehicle 3 is 0 degrees (positioned on a straight line), the curvature of the running track drawn by the towed vehicle 3 when pushed by the reversing towing vehicle 2 is 0. On the other hand, as shown in the lower diagram of Figure 7, if the connection angle between the towing vehicle 2 and the towed vehicle 3 becomes larger than 0 degrees, the curvature of the running track drawn by the towed vehicle 3 when pushed by the reversing towing vehicle 2 becomes larger than 0. And, the larger the connection angle between the towing vehicle 2 and the towed vehicle 3, the larger the curvature of the running track of the towed vehicle 3 (the smaller the turning radius).
[0038] When the towing vehicle 2 towing the towed vehicle 3 reverses and parks, it is important to increase the curvature of the travel path drawn by the towed vehicle 3 in as short a time as possible in order to shorten the total length of the path required for parking. Therefore, as shown in Fig. 8, the towing vehicle 2 first performs a reverse steering operation to steer in the opposite direction (rightward in Fig. 8) to the original turning direction (leftward as seen from the driver in Fig. 8, since the driver wants to turn left rearward), immediately after starting to reverse, and then steers in the original turning direction. On the other hand, when approaching the parking target position, it is necessary to bring the connection angle between the towing vehicle 2 and the towed vehicle 3 closer to 0 degrees, but in order to shorten the total length of the path required for parking, it is effective to maintain the curvature as large as possible until the end, and then quickly reduce the curvature, rather than gradually reducing the curvature, so that an increase in steering in the turning direction is generally performed at the end of the turn.
[0039] When the towing vehicle 2 performs a reverse turning operation and a further turning operation, the curvature of the traveling trajectory of the towing vehicle 2 and the towed vehicle 3 shows a transition as shown in Fig. 9 as an example. That is, by performing a reverse turning operation in the towing vehicle 2, the curvature of the traveling trajectory of the towed vehicle 3 increases from the initial curvature 0 at the start of reverse driving to the turning curvature X at a predetermined increase rate (gradient) α (first section). Then, after the towing vehicle 2 has reversed a predetermined distance while maintaining the turning curvature, the towing vehicle 2 performs a further turning operation, and the curvature of the traveling trajectory of the towed vehicle 3 decreases from the turning curvature X to 0 at a predetermined decrease rate (gradient) β (second section). In the example shown in Fig. 9, α and β are constant values (straight line graph) with respect to the travel distance, but they may also be values that change with respect to the travel distance (curved line graph). In addition, in the virtual parking situation set in S2, it is assumed that the connection angle between the towing vehicle 2 and the towed vehicle 3 is 0 degrees (positioned in a straight line) at the start of reverse movement, but if a situation is envisaged in which the connection angle between the towing vehicle 2 and the towed vehicle 3 is other than 0 degrees at the start of reverse movement, the initial value of the curvature of the driving trajectory of the towed vehicle 3 will be other than 0.
[0040] Then, in S4, the CPU 31 first provisionally sets an arbitrary value as the turning curvature X in order to search for a recommended value of the turning curvature X shown in Fig. 9. As will be described later, the CPU 31 finally judges whether the provisionally set turning curvature X is a recommended value by looking at the total length L of the path required for parking when the turning curvature X provisionally set in S4 is used.
[0041] Next, in S5, the CPU 31 searches for a recommended turning curvature gradient for the towed vehicle 3 when parking is performed in the virtual parking situation set in S2. The turning curvature gradient is an increase rate (an increase in curvature per unit travel distance) when the curvature of the travel path of the towed vehicle 3 is increased by the reverse turning operation of the towing vehicle 2, and is the value of α shown in FIG.
[0042] A method for searching for a recommended value for the turning curvature gradient α will be described below. FIG. 10 is a diagram showing the relationship between the curvature of the travel path of the towing vehicle 2 and the turning curvature gradient α of the travel path of the towed vehicle 3 during the reverse turning operation of the towing vehicle 2. The curvature of the travel path shown in FIG. 10 can be derived by calculating the possible travel paths of the towing vehicle 2 and the towed vehicle 3 using the trailer wheel base, which is the distance from the rotation center of the towed vehicle 3 to the coupling point acquired in S1 for the virtual parking situation set in S2, and the distance from the rear wheel axle of the towing vehicle 2 to the coupling point of the towing vehicle 2 and the towed vehicle 3, and extracting the curvature from the calculated travel path. As shown in FIG. 10, the larger the negative curvature during the reverse turning operation of the towing vehicle 2, the larger the turning curvature gradient α of the travel path of the towed vehicle 3. On the other hand, the larger the turning curvature gradient α, the shorter the distance required for the towed vehicle 3 to turn, so it is estimated that the total length of the route required for parking will be shorter. Therefore, as shown in Fig. 10, the curvature of the towing vehicle 2 in the reverse turning operation is changed stepwise, and the maximum value of the turning curvature gradient α is searched for under the condition that the traveling path of the towing vehicle 2 does not exceed the maximum curvature set in S3. Specifically, the turning curvature gradient α of the traveling path of the towed vehicle 3 corresponding to the case where the traveling path of the towing vehicle 2 is the maximum curvature set in S3 (for example, -0.15 [1 / m] in the example shown in Fig. 10) is the recommended value. Also, if the steering angular velocity limit value is exceeded when reversing at an assumed reverse vehicle speed (for example, 4 km / h) using the searched turning curvature gradient α, the turning curvature gradient α is reduced to a value that does not exceed the steering angular velocity limit value.
[0043] Next, in S6, the CPU 31 searches for a recommended steering curvature gradient for the towed vehicle 3 when parking is performed in the virtual parking situation set in S2. The steering curvature gradient is a reduction rate (a reduction value of the curvature per unit travel distance) when the curvature of the travel path of the towed vehicle 3 is reduced by the steering operation of the towing vehicle 2, and is the value β shown in FIG.
[0044] A method for searching for a recommended value for the turnback curvature gradient β will be described below. FIG. 11 is a diagram showing the relationship between the curvature of the travel path of the towing vehicle 2 and the return curvature gradient β of the travel path of the towed vehicle 3 during the turning motion of the towing vehicle 2. The curvature of the travel path shown in FIG. 11 can be derived by calculating possible travel paths of the towing vehicle 2 and the towed vehicle 3 using the trailer wheel base, which is the distance from the rotation center of the towed vehicle 3 to the coupling point acquired in S1 for the virtual parking situation set in S2, and the distance from the rear wheel axle of the towing vehicle 2 to the coupling point of the towing vehicle 2 and the towed vehicle 3, and extracting the curvature from the calculated travel path. As shown in FIG. 11, the larger the positive curvature during the turning motion of the towing vehicle 2, the larger the return curvature gradient β of the travel path of the towed vehicle 3. On the other hand, the larger the return curvature gradient β, the shorter the distance required for the towed vehicle 3 to turn, so it is estimated that the total length of the route required for parking will be shorter. Therefore, as shown in Fig. 11, the curvature of the towing vehicle 2 in the further turning operation is changed stepwise, and the maximum value of the return curvature gradient β is searched for under the condition that the traveling path of the towing vehicle 2 does not exceed the maximum curvature set in S3. Specifically, the return curvature gradient β of the traveling path of the towed vehicle 3 corresponding to the case where the traveling path of the towing vehicle 2 is the maximum curvature set in S3 (for example, +0.2 [1 / m] in the example shown in Fig. 11) is the recommended value. Also, if the steering angular velocity limit value is exceeded when reversing at an assumed reverse vehicle speed (for example, 4 km / h) using the searched return curvature gradient β, the return curvature gradient β is reduced to a value that does not exceed the steering angular velocity limit value.
[0045] Thereafter, in S7, the CPU 31 calculates the total length L of the route required for parking in order to determine whether or not each of the values provisionally set and searched for in S4 to S6 is a recommended value. Note that L may be calculated based on either the travel path of the towing vehicle 2 or the travel path of the towed vehicle 3. For example, when calculating based on the travel path of the towed vehicle 3, the calculation is performed using the formula shown in FIG.
[0046] Similarly, the value of the turning curvature X arbitrarily set in S4 is changed as appropriate, and the processes of S4 to S7 are repeated. Then, the recommended values of the turning curvature X, the turning curvature gradient α, and the turning back curvature gradient β are specified, with a priority given to shortening the total length L of the path required for parking. Specifically, a combination of the turning curvature X, the turning curvature gradient α, and the turning back curvature gradient β that minimizes L calculated in S7 is searched for, and after specifying the combination of the turning curvature X, the turning curvature gradient α, and the turning back curvature gradient β that minimizes L, each specified value is stored in the flash memory 34 or the like as a recommended value to be used for generating a travel trajectory (S8).
[0047] In this embodiment, the trailer wheel base, which is the distance from the rotation center of the towed vehicle 3 to the coupling point, used to derive the recommended parameters is the trailer wheel base, which is the distance from the rotation center of the currently coupled towed vehicle 3 to the coupling point, but a virtual trailer wheel base may be used. For example, the trailer wheel base may be set to 2 m, 2.5 m, 3 m, 3.5 m, and 4 m, and the above-mentioned parameter specification processing program may be executed for each trailer wheel base to derive the recommended parameters. This makes it unnecessary to execute the above-mentioned parameter specification processing program every time the coupled towed vehicle 3 is changed, and makes it possible to easily specify the parameters recommended for the coupled towed vehicle 3.
[0048] Here, Fig. 13 is a diagram showing the relationship between the trailer wheelbase and the parameters derived in S8. As shown in Fig. 13, when the trailer wheelbase of the towed vehicle 3 is in the range of 2m to 4m, the influence of the trailer wheelbase of the towed vehicle 3 on the recommended turning curvature X is small, but it can be seen that the larger the trailer wheelbase, the smaller the values derived for the recommended turning curvature gradient α and the returning curvature gradient β. Note that, by performing linear interpolation as shown in Fig. 13, it is possible to identify recommended parameters for trailer wheelbases other than 2m, 2.5m, 3m, 3.5m, and 4m.
[0049] The same applies to the coupling distance; for example, in the above embodiment, the distance from the rear wheel axle of the towing vehicle 2 to the coupling point of the towing device 4 currently equipped on the towing vehicle 2 is used, but a virtual coupling distance may be used as in the case of the trailer wheelbase. For example, the coupling distance may be set to 2 m, 2.5 m, 3 m, 3.5 m, and 4 m, and the above-mentioned parameter identification processing program may be executed for each coupling distance to derive recommended parameters. This makes it possible to easily identify recommended parameters for the towing device 4 equipped on the towing vehicle 2 without having to execute the above-mentioned parameter identification processing program every time the towing device 4 equipped on the towing vehicle 2 is changed.
[0050] In addition, the parameters derived in S8 are recommended for a parking situation where parking is performed by turning at one approach angle Δθ (e.g., 60 degrees) set in S2, but the derived parameters can also be used as recommended parameters in parking situations where parking is performed at an approach angle other than the approach angle Δθ set in S2 (e.g., 90 degrees or 45 degrees). However, multiple angles may be set as the approach angle Δθ, and a recommended parameter may be derived for each Δθ.
[0051] Then, the CPU 31 uses the recommended values of the turning curvature X, the turning curvature gradient α, and the turning back curvature gradient β derived in S8 to generate a travel trajectory of the towing vehicle 2 when actually parking, as described below.
[0052] 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. 14. Fig. 14 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. 14 below is stored in the RAM 32 and ROM 33 of the parking assist device 1, and is executed by the CPU 31.
[0053] First, in S11, 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 are 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.
[0054] Next, in S12, 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 S12, 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.
[0055] Next, in S13, the CPU 31 acquires a forward trajectory of the towing vehicle 2, which moves forward while turning from the parking start position acquired in S11 toward the direction of the towing vehicle 2 acquired in S12 in a direction away from the parking target position. Here, the travel trajectory, particularly when performing reverse parking, has a forward section in which the towing vehicle moves forward once to a turning position appropriate for entering the parking target position, such as a parking space, which is a parking target, and a reverse section in which the towing 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. The forward trajectory of the towing vehicle 2 is basically a travel trajectory of a fixed shape prepared in advance, but the prepared forward trajectory may be modified and used, for example, when the surrounding vacant space is not large enough.
[0056] Here, Fig. 15 is a diagram showing an example of the forward trajectory of the towing vehicle 2 acquired in S13. As shown in Fig. 15, the forward trajectory 41 of the towing vehicle 2 is a trajectory in which the towing vehicle 2 moves diagonally forward and in which a plurality of clothoid curves are connected. For example, the forward trajectory 41 shown in Fig. 15 is a combination of a first clothoid curve that moves while gradually turning the steering wheel to the left from the parking start position S (i.e., while the curvature gradually changes to a larger value) and a second clothoid curve that moves while gradually returning the steering wheel to a straight forward direction (i.e., while the curvature gradually changes to a smaller value). The direction of the lateral movement is a direction away from the parking target position G, and the length of the forward trajectory is a trajectory that allows the towing vehicle 2 to move at least farther than the parking target position G.
[0057] Thereafter, in S14, the CPU 31 predicts the transition of the travel trajectory and connection angle (hitch angle) of the towed vehicle 3 when the towing vehicle 2 moves along the forward trajectory acquired in S13, and acquires the predicted transition of the travel trajectory and connection angle as the transition of the forward trajectory of the towed vehicle 3 and the connection angle while traveling on the forward trajectory. The prediction of the transition of the travel trajectory and connection angle of the towed vehicle 3 is performed based on various information stored in the vehicle information DB 21 (e.g., the distance from the rear wheel axle of the towing vehicle 2 to the connection point (position of the hitch ball 5) between the towing vehicle 2 and the towed vehicle 3, the trailer wheel base, etc.) and the orientation and connection angle of the towed vehicle 3 acquired in S12. FIG. 15 also shows an example of the forward trajectory 42 of the towed vehicle 3 predicted when the towing vehicle 2 moves along the forward trajectory 41.
[0058] Next, in S15, the CPU 31 sets candidate turning positions on each forward trajectory acquired in S13 and S14 as candidates for positions where the towing vehicle 2 and the towed vehicle 3 will turn (switch from forward to reverse). Note that as shown in Fig. 16, a plurality of turning position candidates are set from the start point to the end point of the forward trajectory at a predetermined distance interval (for example, 1 m interval or 50 cm interval). Note that the interval and number of the set turning position candidates can be changed as appropriate. Also, turning position candidates may be set only in a range (near the center) that is particularly likely to be a turning position, rather than from the start point to the end point of the forward trajectory.
[0059] The following processing of S16 to S18 is executed for each of the candidate turning-around positions set in S15, and the reverse trajectories of the towing vehicle 2 and the towed vehicle 3 on the assumption that reverse is started from the candidate turning-around position set on the forward trajectory in S15 are calculated for each candidate as follows: Then, after executing the processing of S16 to S18 for all of the candidate turning-around positions set in S15, the process proceeds to S19.
[0060] As explained in the parameter identification processing program (FIG. 5), when the towing vehicle 2 towing the towed vehicle 3 reverses and parks, the towing vehicle 2 performs a reverse turning operation and a further turning operation (FIG. 8). As a result of the reverse turning operation and the further turning operation of the towing vehicle 2, the curvature of the traveling trajectory of the towing vehicle 2 and the towed vehicle 3 shows a transition as shown in FIG. 9 as an example. That is, by performing a reverse turning operation in the towing vehicle 2, the curvature of the traveling trajectory of the towed vehicle 3 increases at a predetermined increase rate (gradient) α from the initial curvature at the start of reverse turning (0 in FIG. 9) to the turning curvature X (first section). Then, after the towing vehicle 2 reverses a predetermined distance while maintaining the turning curvature, the towing vehicle 2 performs a further turning operation, and the curvature of the traveling trajectory of the towed vehicle 3 decreases from the turning curvature X to 0 at a predetermined decrease rate (gradient) β (second section). In the parameter identification processing program (FIG. 5) described above, recommended values of the turning curvature X, the turning curvature gradient α, and the turning back curvature gradient β are derived. First, in S16, the CPU 31 reads and obtains these recommended values from the flash memory 34.
[0061] Next, in S17, the CPU 31 determines the connection angle (hitch angle) between the towing vehicle 2 and the towed vehicle 3 at the time when they are located at the candidate turning position based on the change in the connection angle (hitch angle) between the towing vehicle 2 and the towed vehicle 3 when they move forward along the forward trajectory predicted in S14.
[0062] Here, the initial curvature of the travel trajectory of the towed vehicle 3 is determined by the connection angle between the towing vehicle 2 and the towed vehicle 3 at the start of reverse movement, i.e., at the time of turning around. Specifically, as shown in Fig. 17, if the towing vehicle 2 faces the parking target position side with respect to the traveling direction of the towed vehicle 3 at the time of turning around, the initial curvature is greater than 0 (a trajectory that starts turning in the same direction as the turning direction to the parking target position), and as shown in Fig. 18, if the towing vehicle 2 faces the opposite side to the parking target position with respect to the traveling direction of the towed vehicle 3 at the time of turning around, the initial curvature is smaller than 0 (a trajectory that starts turning in the opposite direction to the turning direction to the parking target position). Then, in S17, the initial curvature is specified based on the connection angle between the towing vehicle 2 and the towed vehicle 3 at the time of being located at the turning around position candidate and various information stored in the vehicle information DB 21.
[0063] Thereafter, in S18, the CPU 31 calculates the reverse trajectories of the towing vehicle 2 and the towed vehicle 3 on the assumption that reverse starts from the target turning position candidate based on the recommended values of the turning curvature X, the turning curvature gradient α, and the turning curvature gradient β acquired in S16 and the initial curvature identified in S17. Also, based on the parking target position acquired in S11 and the target turning position candidate, the CPU 31 identifies the approach angle Δθ (corresponding to the angle amount required to turn to approach the parking target position) from the target turning position candidate to the parking target position (see FIG. 6), and the reverse trajectory calculated in S18 is a trajectory that matches the approach angle Δθ. However, it does not matter whether the reverse trajectory passes through the parking target position while matching the approach angle Δθ. It is not necessary to calculate the reverse trajectory of both the towing vehicle 2 and the towed vehicle 3, and only one of them may be calculated.
[0064] Here, Fig. 19 is a diagram showing an example of the reverse trajectory calculated in S18. As shown in Fig. 19, the reverse trajectory 43 of the towing vehicle 2 is a trajectory that reverses from the candidate turning position to be processed that is set on the forward trajectory 41 of the towing vehicle 2. Also, the reverse trajectory 44 of the towed vehicle 3 is a trajectory that reverses from the candidate turning position to be processed that is set on the forward trajectory 42 of the towed vehicle 3. In particular, the reverse trajectory 43 of the towing vehicle 2 is a traveling trajectory that includes the above-mentioned reverse turning operation and further turning operation, and the reverse trajectory 44 of the towed vehicle 3 includes a section (first section) in which the vehicle travels while increasing the curvature from the initial curvature to the recommended turning curvature X with a recommended further turning curvature gradient α, a section in which the vehicle travels while maintaining the turning curvature X, and a section (second section) in which the vehicle travels while decreasing the curvature from the turning curvature X with a recommended return curvature gradient β. In addition, the approach angle Δθ to the parking target position is adjusted for the reverse trajectories 43 and 44. In other words, the reverse trajectories 43 and 44 are trajectories that turn the amount required to approach the parking target position, but they do not necessarily pass through the parking target position.
[0065] Then, the processes of S16 to S18 are executed for all the candidate turning-back positions set in S15, and the reverse trajectory is calculated, and then the process proceeds to S19.
[0066] In S19, the CPU 31 compares the reverse trajectories calculated in S18 with each of the candidate turning-around positions, and selects the candidate turning-around position from among the multiple candidate turning-around positions, which has the end point of the reverse trajectory closest to the parking target position. Note that the reverse trajectories of the towing vehicle 2 may be compared, or the reverse trajectories of the towed vehicle 3 may be compared. For example, Fig. 20 shows an example in which the reverse trajectories 44 of the towed vehicle 3 are compared, and in the example shown in Fig. 20, the end point of the second reverse trajectory 44 from the right is closest to the parking target position G, so the candidate turning-around position corresponding to that reverse trajectory 44 is selected.
[0067] Next, in S20, the CPU 31 corrects the turn-back position candidate selected in S19 in a direction in which the end point of the reverse trajectory approaches the parking target position, and finally determines the corrected turn-back position candidate as the turn-back position. For example, when comparing the reverse trajectories 44 of the towed vehicle 3 as shown in Fig. 20, if the end point of the reverse trajectory 44 of the turn-back position candidate selected in S19 is shifted to the right with respect to the parking target position G, the end point of the reverse trajectory 44 can be brought closer to the parking target position G by moving the turn-back position candidate along the forward trajectory 42 toward the parking start position as shown in Fig. 21. On the other hand, if the end point of the reverse trajectory 44 of the turn-back position candidate selected in S19 is shifted to the left with respect to the parking target position G, the end point of the reverse trajectory 44 can be brought closer to the parking target position G by moving the turn-back position candidate along the forward trajectory 42 toward the side away from the parking start position (forward) as shown in Fig. 21.
[0068] However, it is preferable to correct the candidate turning position in the step S20 so that the end point of the reverse trajectory is a position a predetermined distance (e.g., 30 cm) forward (away from the parking start position) along the forward trajectory from the turning position where the end point of the reverse trajectory completely coincides with the parking target position. This makes it possible to correct the position during reverse without having to redo the parking operation even if an error occurs in the measurement or calculation during the process of the steps S11 to S20, i.e., even if the reverse trajectory from the turning position finally determined in the step S20 is actually a trajectory that is difficult to reach the parking target position.
[0069] Next, in S21, the CPU 31 outputs, among the forward trajectories acquired in S13 and S14, a combination of the forward trajectory up to the turning position determined in S20 and the reverse trajectory reversing from the turning position determined in S20 as a recommended travel trajectory from the parking start position to the parking target position. The calculation of the reverse trajectory reversing from the turning position determined in S20 is the same as in S18, so a description thereof will be omitted. In addition, in S21, only the travel trajectory of either the towing vehicle 2 or the towed vehicle 3 may be output. Also, the forward trajectory may be the travel trajectory of the towing vehicle 2 and the reverse trajectory may be the travel trajectory of the towed vehicle 3, or vice versa.
[0070] The parking assistance device 1 can then control each drive unit based on the travel trajectory output in S21 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 S21, to the vehicle control ECU 24 via 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 S21. 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 S21.
[0071] 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.
[0072] As described above in detail, the parking assistance device 1 and the computer program executed by the parking assistance device 1 according to this embodiment set the maximum value of the curvature or steering angle permissible for the running track of the towing vehicle 2 (S3), obtain the trailer wheelbase, which is the distance from the rotation center of the towed vehicle 3 to the coupling point, and the coupling distance, which is the distance from the rear wheel axle of the towing vehicle 2 to the coupling point between the towing vehicle 2 and the towed vehicle 3 (S1), and, under the condition that the curvature or steering angle of the running track of the towing vehicle 2 does not exceed the maximum value, determine recommended values of the turning curvature and the curvature gradient of the second section of the running track of the towed vehicle 3 when parked based on the trailer wheelbase and the coupling distance (S4 to S8). Therefore, taking into account the maximum value of the curvature or steering angle permissible for the running track of the towing vehicle, it is possible to determine recommended values for the maximum value of the curvature and gradient of the running track of the towed vehicle based on the trailer wheelbase, which is the distance from the rotation center of the towed vehicle 3 to the coupling point, and the distance from the rear wheel axle of the towing vehicle to the coupling point. As a result, a driving trajectory that cannot be followed during parking is not generated, and a more appropriate driving trajectory can be calculated using the recommended values. Furthermore, on the condition that the curvature or steering angle of the towing vehicle 2's running track does not exceed the maximum value, a recommended value for the curvature gradient of the first section is determined based on the trailer wheelbase and the connection distance (S4 to S8), so that it is possible to determine a recommended value for the curvature gradient of the towed vehicle's running track, which rises particularly when a reverse turning operation is performed. In addition, the recommended values of the predetermined turning curvature and the curvature gradient of the first section and the curvature gradient of the second section are respectively specified (S4 to S8) with a priority given to shortening the total length of the path required for parking, so that it is possible to calculate a driving trajectory that is impossible to follow when parking and that completes parking in the shortest possible movement. In addition, a first maximum value permissible on a driving trajectory where the towing vehicle 2 turns in the same direction as the towed vehicle 3, and a second maximum value permissible on a driving trajectory where the towing vehicle 2 turns in a direction different from that of the towed vehicle 3 are set, and further the second maximum value is set to a value smaller than the first maximum value, so that it is possible to appropriately set the permissible maximum values of curvature and steering angle taking into account the turning direction.
[0073] 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, when setting (S3) the maximum curvature allowable for the driving trajectory of the towing vehicle 2 in the parameter identification processing program (see FIG. 5), a first maximum curvature allowable for the driving trajectory when the towing vehicle 2 turns in the same direction as the towed vehicle 3 (in the example shown in FIG. 6, to the right along the reverse direction), and a second maximum curvature allowable for the driving trajectory when the towing vehicle 2 turns in a different direction from the towed vehicle 3 (in the example shown in FIG. 6, to the left along the reverse direction), are respectively set, and further, the second maximum curvature is set to a value smaller than the first maximum curvature, but the first maximum curvature may be the same as the second maximum curvature or the first maximum curvature may be a value smaller than the second maximum curvature.
[0074] In this embodiment, a maximum allowable curvature is set for the travel path of the towing vehicle 2, but it is also possible to set a maximum allowable steering angle instead of the curvature. Note that since the curvature of the travel path of the towing vehicle 2 and the steering angle of the towing vehicle 2 traveling along the travel path are basically linked, it is possible to set a maximum steering angle instead of the maximum curvature without any problems.
[0075] In this embodiment, the parameter identification processing program (see FIG. 5) identifies recommended values for the turning curvature X, the turning curvature gradient α, and the turning curvature gradient β. However, instead of identifying recommended values for all of these parameters, it is also possible to identify recommended values for only some of the parameters.
[0076] In this embodiment, the parking assistance processing program (FIG. 14) selects the candidate turning-back position where the end point of the reverse trajectory is closest to the parking target position from among a plurality of candidates for the turning-back position (S19), and then corrects the selected candidate turning-back position (S20) before deciding it as the turning-back position, but the correction in S20 is not necessarily required. That is, the candidate turning-back position selected in S19 may be decided as the turning-back position.
[0077] In this embodiment, the parking assist ECU 23 of the parking assist device 1 executes the parameter identification processing program (see FIG. 5) and the parking assist processing program (FIG. 14), but the executing entity can be changed as appropriate. For example, 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 may execute the programs. [Explanation of symbols]
[0078] 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...forward trajectory of towing vehicle, 42...forward trajectory of towed vehicle, 43...reverse trajectory of towing vehicle, 44...reverse trajectory of towed vehicle
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 travel trajectory of the towed vehicle during parking includes a first section in which the towed vehicle reverses while increasing a curvature from an initial curvature at the start of reverse to a predetermined turning curvature, and a second section in which the towed vehicle reverses while decreasing a curvature from the predetermined turning curvature, a maximum value setting unit that sets a maximum value of a curvature or a steering angle allowed for a travel trajectory of the towing vehicle; 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, which is a distance from a rear wheel axle of the towing vehicle to the coupling point; and a parameter specifying unit that specifies recommended values of the predetermined turning curvature and the curvature gradient of the second section of the driving path of the towed vehicle when parked, based on the trailer wheel base and the connection distance, under the condition that the curvature or steering angle of the driving path of the towing vehicle does not exceed the maximum value.
2. 2. The parking assistance device according to claim 1, wherein the parameter specification unit specifies a recommended value of the curvature gradient of the first section based on the trailer wheel base and the coupling distance, on the condition that the curvature or steering angle of the travel trajectory of the towing vehicle does not exceed the maximum value.
3. 3. The parking assistance device according to claim 2, wherein the parameter specification unit specifies recommended values of the predetermined turning curvature, the curvature gradient of the first section, and the curvature gradient of the second section, giving priority to shortening the overall length of a path required for parking.
4. the maximum value setting unit sets, as the maximum value, a first maximum value permitted on a travel path in which the towing vehicle turns in the same direction as the towed vehicle, and a second maximum value permitted on a travel path in which the towing vehicle turns in a direction different from that of the towed vehicle, 4. The parking assistance device according to claim 1, wherein the second maximum value is smaller than the first maximum value.
Citation Information
Patent Citations
Parking route generating device and parking control device
JP2022107175A
