1. Introduction
In recent years, with the continuous improvement in the national economy, the automotive industry has developed rapidly, leading to a sharp increase in the number of vehicles and resulting in increasingly severe issues such as traffic congestion, limited parking spaces, and the difficulty of finding parking. To effectively address these problems, automatic parking technology has emerged and gradually become a key technical means to solve them [
1]. Currently, automatic parking technology mainly consists of three key components: environmental perception, path planning, and tracking control [
2]. Among these, the primary goal of path planning is to devise a collision-free path that complies with the vehicle’s dynamic constraints based on the vehicle’s current position and the target parking space in specific parking scenarios. As one of the core technologies of automatic parking systems, the quality of path planning directly affects the overall performance of the system. Therefore, researching parking path planning algorithms that adapt to complex environments holds significant practical importance and broad application value.
As a critical component of intelligent driving technology, automated parking systems rely on three core technologies: environmental perception, path planning, and trajectory tracking control [
3]. Among these, path planning plays a pivotal role in determining the performance of the system, directly influencing the smoothness and efficiency of the parking process [
4,
5]. Despite the availability of various path planning methods, technical difficulties remain in practical applications. For instance, paths generated by traditional geometric methods often exhibit curvature discontinuities at transitions between arcs and straight lines, necessitating in-place steering adjustments that compromise vehicle maneuverability and ride comfort [
6,
7,
8,
9]. Although introducing straight segments or clothoid curves alleviates this issue to some extent [
10,
11], such methods are highly dependent on the initial vehicle pose, limiting their adaptability across scenarios. On the other hand, numerical optimization methods can generate curvature-continuous paths by constructing multi-objective optimization models, effectively optimizing path time or length [
12,
13,
14,
15], but their high computational complexity makes real-time application challenging. Sampling-based approaches, such as the RRT algorithm, enhance adaptability to complex scenarios by randomly sampling in free space and constructing a path graph [
16,
17]. However, they suffer from poor path smoothness and long computation times. Machine learning-based strategies, particularly those leveraging imitation learning or reinforcement learning, improve generalizability in path planning [
18,
19,
20,
21,
22,
23], but the performance gap between simulation environments and real-world applications still needs to be addressed.
To address these challenges, researchers worldwide have proposed several improved methods in recent years. For example, Ref. [
8] proposed a planning method based on tangential arcs and straight lines, which is computationally simple but still suffers from curvature discontinuities. The study in [
13] developed a multi-objective optimization model to generate optimal parking paths with improved smoothness. Reference [
24] combined sampling methods with nonlinear optimization algorithms, enhancing adaptability across various parking scenarios. Moreover, Ref. [
23] applied reinforcement learning techniques, using nonlinear programming to generate training data and optimize policy networks, thereby improving system generalization. As shown in
Table 1, a comparison of automated parking path planning methods reveals the strengths and limitations of various approaches.
To address these limitations, this study proposes a vertical parking path planning method that combines circular arcs, straight lines, and a multi-objective optimization function. From a broader market perspective, this approach holds significant potential for integration into real-world autonomous parking systems, particularly in vehicles with advanced parking technologies. As autonomous vehicles continue to gain traction, the adoption of this method in vehicle systems may lead to notable improvements in parking efficiency and safety. Additionally, future advancements, such as the incorporation of rear-wheel steering or advanced obstacle detection systems, could further enhance the performance and effectiveness of the proposed method.
2. Vehicle Modeling and Parking Scene Construction
2.1. Kinematic Modeling of the Vehicle
In the parking process, the vehicle typically operates at speeds below 5 km/h, where lateral sliding of the wheels is generally negligible. For simplicity, the wheels are assumed to perform only rolling and steering motions, and the vehicle is modeled as a rigid body [
25]. This assumption neglects factors such as tire deformation and frictional forces that might affect the vehicle’s motion in real-world conditions. Based on the Ackermann steering principle, a kinematic model of the vehicle was constructed, as shown in
Figure 1. While this simplified model is useful for path planning in controlled environments, it may not fully account for the complexities of vehicle dynamics in more challenging parking scenarios, such as those involving steep slopes or low-traction surfaces.
The vehicle kinematic equations presented in this paper are as follows:
In the equation,
represents the vehicle’s wheelbase,
denotes the vehicle’s heading angle, (
) represents the coordinates of the front axle center, (
) represents the coordinates of the rear axle center,
is the vehicle’s equivalent front wheel steering angle,
represents the velocity at the front axle center, and
represents the velocity at the rear axle center. When the vehicle is driving with the minimum turning radius, the minimum turning radius
, the maximum steering angle
of the front wheels, and the minimum turning radius
at the rear axle center satisfy the following relationship:
In autonomous parking research, the vehicle’s motion state is primarily represented by the coordinates () of the rear axle center in the coordinate system, as well as the heading angle . In path planning, to ensure that the vehicle does not collide with obstacles in the parking environment during the path planning process, it is also necessary to describe the motion of the vehicle’s body outline. By combining the vehicle’s front overhang length , rear overhang length , and vehicle width , the coordinates of the four vertices , , , and can be obtained as follows:
The front-left vertex
of the vehicle:
The front-right vertex
of the vehicle:
The rear-right vertex
of the vehicle:
The rear-left vertex
of the vehicle:
2.2. Parking Scene Setting
This study primarily focuses on vertical parking spaces, and its simplified model is shown in
Figure 2. The direction perpendicular to the parking space is defined as the
X-axis, while the direction parallel to the parking space is defined as the
Y-axis, establishing the global coordinate system for vertical parking. Considering the generality of the path planning algorithm, according to the ISO 16787 standard [
26], for test vehicles with a length of 4 m or less, the parking space length
is equal to the length of the test vehicle
, and the parking space width
is the width of the test vehicle
plus 1.2 m. The road width
is 4.5 m. The relevant parameters are shown in
Table 2.
The proposed path planning method assumes a flat parking space. However, in real-world scenarios, parking areas may feature varying slopes and curvatures that can significantly influence the vehicle’s trajectory. These topological parameters are not considered in the current study, but future research will investigate how to integrate these factors into the model. By incorporating slope and curvature variations, we aim to enhance the robustness and applicability of the path planning method in complex parking environments.
In real-world vertical parking scenarios, parking space topography, including slope and curvature, plays a critical role in the vehicle’s path planning. For instance, when the parking area has an incline, the vehicle’s dynamics, such as its ability to steer and its trajectory, may be altered. Similarly, the curvature of the parking space can affect the optimal path design, necessitating adjustments to the planned trajectory to accommodate these variations. The current study does not account for these variations but recognizes the need for further exploration in future research to improve the generalizability and performance of the proposed method. Incorporating topological factors into the model would increase the method’s practical applicability, ensuring it performs effectively in a wider range of real-world parking environments.
3. Research on Vertical Parking Path Planning
Geometric planning methods offer advantages in computational efficiency and real-time performance, particularly when using the arc–line tangent method, which can plan the shortest path. In contrast, numerical optimization methods are unconstrained by the vehicle’s initial parking pose and have strong scene adaptability. Therefore, this research combines the advantages of both geometric and numerical optimization methods and proposes a path planning approach based on arc–line and multi-objective evaluation functions.
As shown in
Figure 3, when the parking starting point
is known, the feasible region of the vertical parking path can be calculated using the following conditions: As shown in
Figure 3a, the rear-left point
of the vehicle does not collide with the left boundary of the parking space; as shown in
Figure 3b, the right side of the vehicle does not collide with the right corner of the parking space; and as shown in
Figure 3c, the front-left point
of the vehicle does not collide with the upper boundary of the parking space.
Based on these conditions, the arc radii of the upper and lower boundaries of the feasible vertical parking region,
and
, as well as the coordinates of the intersection points of the arc and the line,
and
, can be determined, thereby defining the feasible parking path region, as shown in
Figure 3d.
3.1. Determination of the Feasible Region for Vertical Parking
In vertical parking path planning, the determination of the feasible driving region is critical. This study approaches the analysis from the perspectives of the lower and upper boundaries, examining the constraints of the feasible region based on the geometric relationships of the vehicle.
3.1.1. Determination of the Lower Boundary
First, the lower bound of the feasible driving region for vertical parking is determined. As shown in
Figure 4, when the vehicle moves along a smaller arc from the parking starting point, the right side of the vehicle is likely to collide with the upper-right corner
of the parking space. To avoid this collision and maintain a safe distance at point
, the first limiting value of the lower bound arc radius can be calculated based on geometric relationships.
As shown in
Figure 5, when the vehicle plans a path along a smaller arc from the parking starting point
(
), it is also necessary to consider potential collisions with the road boundary. Since the front-left point
of the vehicle is the first to contact the road boundary, in order to avoid a collision and maintain a safety distance
at the road boundary, the second limiting value of the lower boundary arc radius of the feasible vertical parking region,
, can be calculated based on geometric relationships.
In vertical parking path planning, the vehicle’s structural limitations must also be considered. Based on the two limiting values of the lower boundary arc radius of the feasible vertical parking region, the results should be compared with the minimum turning radius
of the vehicle’s rear axle center. The minimum value among the three should be selected as the lower boundary arc radius
of the feasible vertical parking region.
Based on the calculated lower boundary arc radius of the feasible vertical parking region, and considering that the vehicle should be parallel to the parking space’s length direction at the parking endpoint, the straight line equation of the lower boundary of the feasible vertical parking region can be derived using the geometric relationship of the arc–line tangency. The equation is given by .
3.1.2. Determination of the Upper Boundary
For the upper boundary of the feasible driving region in vertical parking, as shown in
Figure 6, when the vehicle follows a larger circular arc path starting from the parking point
(
), the left rear point D of the vehicle reaches its maximum trajectory, making it prone to collision with the left boundary line of the parking space. To avoid such a collision and to maintain a safety margin
from the left boundary line, the upper boundary circular arc radius
can be calculated.
Similarly, based on the geometric relationship of tangency between the circular arc and the straight line, the equation of the upper boundary straight line can be expressed as .
3.2. Design of Multi-Objective Evaluation Function for Vertical Parking
After determining the upper and lower boundaries of the drivable region, theoretically, any combination of circular arcs and straight lines within the region can satisfy the requirements of parking path planning. However, to further optimize parking performance, it is necessary to comprehensively consider factors such as path curvature smoothness, adjustable margin, and path length. Therefore, this study designed a multi-objective evaluation function to optimize and solve for the optimal combination of circular arcs and straight lines within the drivable region.
3.2.1. Path Curvature Smoothness
In vertical parking, avoiding large steering angles requires the path curvature to be as smooth as possible. Path curvature represents the degree of bending along the vehicle’s travel path; the smaller the curvature, the smoother the path. To compute the path curvature, the vehicle’s motion along the circular arc segments and straight segments must be considered. The curvature of the circular arc segments is determined by the radius
of the arc, and the curvature
can be expressed as the reciprocal of the radius:
where
is the radius of the circular arc. A larger curvature indicates a sharper arc, while a smaller curvature corresponds to a smoother arc.
For the straight segments, the curvature is zero because straight lines do not bend:
The total curvature of the path is determined by the weighted average of the curvature in the circular arc and straight line segments. Assuming the vehicle starts at
(
), travels along a circular arc to point
(
), and then proceeds along a straight line to the endpoint
(
); the path curvature
can be expressed as follows:
To ensure the smoothness of the path curvature, upper and lower bounds for the curvature are defined. The maximum curvature occurs when the arc radius is at its minimum, and the minimum curvature occurs when the arc radius is at its maximum, specifically the following:
The constraint for the path curvature
is given by the following:
3.2.2. Maximizing Adjustability at Any Time
To ensure that the vehicle can flexibly adjust its trajectory during parking, the range of the front wheel steering angle needs to be maximized. To maximize the steering angle margin, the following aspects must be considered:
Limit Steering Angles: The minimum and maximum values of the steering angle
correspond to the maximum and minimum values of the turning radius, respectively. When
takes its maximum value, the steering angle
reaches its minimum:
When
takes its minimum value, the steering angle
reaches its maximum:
Margin Optimization: To maximize the steering angle margin, an appropriate turning radius
must be selected during the path planning process, such that the following is satisfied:
By discretizing and optimizing the turning radius, the radius value that provides the maximum adjustable margin can be selected.
3.2.3. Shortest Path Length
In vertical parking path planning, minimizing the path length aims to ensure that the vehicle completes the parking maneuver in the shortest possible distance, thereby reducing parking time and energy consumption. The total path length sis_isi can be expressed as the integral of the curve length of the planned path:
The vertical parking path consists of a circular arc segment and a straight line segment, so the path length needs to be calculated separately for each part.
Arc Segment Length: The length of the arc segment can be calculated using the arc length formula. Assuming the arc radius is
and the central angle is
, the length of the arc
is the following:
where
is the radius of the circular arc, and
is the central angle of the arc.
Line Segment Length: The length of the line segment can be calculated using the distance formula between two points. Assuming the coordinates of the start and endpoints of the line segment are
(
), and
(
), the length of the line segment
is as follows:
The total path length
is the sum of the arc length and the line segment length:
3.2.4. Design of the Evaluation Function
Based on the previous analysis, it is evident that when the path length is minimized, the path curvature is not smooth, and the adjustable margin at any moment is not maximized. These three factors are in conflict with each other. Therefore, an evaluation function is designed to calculate the trade-off between these metrics. The evaluation function is defined as follows:
where
are weight coefficients used to adjust the importance of each metric in the evaluation function; kik_iki represents the path curvature;
denotes the front wheel steering margin; and
is the path length. The standardization of each metric is as follows:
is the normalized value of the path curvature;
is the normalized value of the front wheel steering margin;
is the normalized value of the path length.
To ensure the rationality of the computation, the following constraints are applied: the path curvature is in the range ; the front wheel steering margin is in the range ; and the path length is in the range .
The optimization objective is to minimize the evaluation function , thus balancing the path length, path curvature, and front wheel steering margin.
Explanation of Weight Coefficients Selection:
In this study, the weight coefficients in the evaluation function were chosen based on the actual demands of vehicle dynamics and path planning. The specifics are as follows: (1) Path Curvature: A higher weight was assigned to the path curvature term to ensure smoothness and vehicle controllability during the parking process. Smooth steering is particularly important in parking scenarios to avoid sharp turns that could compromise vehicle handling. This higher weight reduces the possibility of sharp curvature, which would require excessive steering adjustments, thereby enhancing both the comfort and safety of the parking maneuver. (2) Path Length: A moderate weight was given to the path length term with the objective of minimizing the distance the vehicle travels during parking. Minimizing the path length is essential for improving parking efficiency, reducing parking time, and optimizing space usage in confined parking areas. Given that parking spaces are often limited, this aspect of the evaluation function is crucial to ensure the most efficient use of available space. (3) Adjustable Margin: A moderate weight was assigned to the adjustable margin term. This margin ensures that the vehicle can make necessary adjustments during the parking process to avoid collisions with obstacles or the parking space boundaries. A higher weight on the adjustable margin would allow the vehicle to have more flexibility in adjusting its trajectory, improving the system’s robustness.
3.3. Smoothing of Vertical Parking Paths
To avoid in-place steering phenomena in vertical parking path planning, it is necessary to ensure the continuity of path curvature. Curvature continuity requires that the second derivative of the path curve is continuous. Moreover, since the front wheel steering angle serves as the output of the control system and cannot exhibit abrupt changes during parking, the curve type must also ensure the continuity of the third derivative.
Considering that paths generated by the tangential method of arcs and straight lines generally exhibit a “C”-shaped pattern, this study employs a quartic polynomial to smooth the parking path. The expression for the quartic polynomial is given as follows:
The coefficients of the quartic polynomial can be determined using the known points: the parking start point ), the parking endpoint , and the intersection point between the arc and the straight line. The specific solution process is as follows:
To ensure that the vehicle’s orientation at the parking endpoint is perpendicular to the parking space, the slope of the path at the endpoint must approach infinity. To simplify the calculations, the global coordinate system is rotated counterclockwise by 45°. The transformed coordinate system is represented as follows:
To ensure that the path passes through both the parking start and endpoint coordinates, the following constraints are applied:
To ensure that the vehicle is parallel to the parking space at the starting point and perpendicular at the endpoint, the slope of the quartic polynomial must satisfy the following conditions:
To ensure obstacle avoidance, the path must pass through the intersection point
of the arc and the straight line. The corresponding constraint is as follows:
Ultimately, by optimizing this evaluation function, the optimal combination of circular and straight paths within the drivable area is determined to achieve efficient and accurate vertical parking path planning.
4. Simulation Verification of Vertical Parking Path Planning
To validate the effectiveness of the proposed path planning method in vertical parking scenarios, this section presents a verification using the MATLAB R2020b simulation platform, with comparisons made to traditional geometric methods and numerical optimization methods. The experimental results demonstrate that the proposed method shows significant advantages in terms of path planning accuracy, computational efficiency, and curvature smoothness.
4.1. Determination of the Feasible Region for Vertical Parking
The simulation scene is designed based on the standard “Performance Requirements and Testing Methods for Intelligent Parking Assist Systems” (GB/T 41630-2022) [
27], selecting the geometric characteristics of a typical small car. The specific parameters are as follows: vehicle length is 2 m, width is 1.4 m, and wheelbase is 2.8 m; parking space length is 5 m and width is set to 3 m; road width is 4.5 m, with a safety margin of 0.05 m reserved; the minimum turning radius is 1.8 m.
In the design of the multi-objective evaluation function, the following indicators are considered: adjustable margin () reflecting the vehicle’s ability to correct deviations from the expected trajectory; path curvature () indicating the comfort of vehicle control; and path length () impacting the economic efficiency of parking.
4.2. Simulation Experiment and Comparative Analysis
By setting weight coefficients to balance safety, comfort, and economy, the proposed method was implemented on the MATLAB R2020b platform and compared with traditional geometric methods and numerical optimization methods. The experimental results show that the path generated by the proposed method has a length of 3.52 m, which is 15% shorter than the traditional geometric method and 2% shorter than the numerical optimization method, as shown in
Figure 7. The time required to generate the path is 3.0 s, 40% shorter than the numerical optimization method, but slightly higher than the 0.8 s of the traditional geometric method, as shown in
Figure 8. Additionally, the curvature fluctuation amplitude of the path is 0.08, which is 80% lower than that of the traditional geometric method and comparable to the 0.1 of the numerical optimization method, as shown in
Figure 9. Overall, the proposed method significantly optimizes path length, curvature smoothness, and computational efficiency, with specific comparative results shown in
Table 3.
In the context of this study, several simplifying assumptions were made to streamline the modeling and path planning process. For example, the vehicle was modeled as a rigid body, and it was assumed that the wheels perform only rolling and steering motions. These simplifications reduce the model’s complexity, allowing for more efficient path generation. However, it is important to note that the relationship between the steering angle and the turning of the vehicle’s wheels is not strictly linear in reality. This could introduce some inaccuracies when applying the model to more complex or dynamic environments.
While these assumptions provided reasonably accurate predictions for the paths in this study, they may cause errors in more complex scenarios, such as when driving on low-traction surfaces or at larger steering angles. For instance, the assumption that lateral sliding of the wheels can be neglected during low-speed driving holds true for the parking scenarios in this study. However, in environments with lower traction or higher steering angles, tire slip may become more significant, potentially altering the trajectory of the vehicle.
To assess the impact of these simplifying assumptions, sensitivity analysis was conducted by varying friction coefficients and turning radii. The results showed minor deviations between the predicted paths and real-world data, particularly in conditions with low traction or large steering angles. While these deviations were minimal in the simulated parking scenarios, they may become more noticeable in real-world applications. Future research will aim to incorporate the effects of tire slip and the nonlinear relationship between the steering angle and wheel rotation, which should improve the accuracy and broader applicability of the proposed method.
4.3. Vehicle Motion Trajectory Validation
The parking starting point coordinates (3.3, 3.6) were chosen for calculation. Using Matlab R2020b, the optimal combination of circular arcs and straight lines within the drivable area was obtained, as shown in
Figure 10. The radius of the circular arc corresponding to the upper boundary of the drivable area is 2.8 m, while the radius corresponding to the lower boundary is 2.6 m. The optimal combination of circular arcs and straight lines has a circular arc radius of 2.7 m, situated in the middle of the drivable area.
As shown in
Figure 11, the planned path curve is a smooth and continuous trajectory that connects the starting and ending points of the parking maneuver. The four body contour vertices of the target vehicle, labeled A, B, C, and D, meet the obstacle avoidance requirements, meaning each vertex can reach its corresponding endpoint without collision from its initial position. This indicates that the vertical parking path curve, planned using a fourth-degree polynomial, satisfies both position constraints and obstacle avoidance constraints.
As shown in
Figure 12a, the derivative of the planned rear axle midpoint path curve at the parking starting point is −1, while at the parking endpoint, the derivative is 1. This indicates that at the parking starting point, the vehicle’s body orientation is parallel to the horizontal direction of the parking space, whereas at the parking endpoint, the body orientation is perpendicular to the horizontal direction, thus satisfying the parking posture constraints. In
Figure 12b, the planned rear axle midpoint path curvature is within the range of [−0.05406, 0.01887], which complies with the maximum allowable curvature requirements. Additionally,
Figure 12c demonstrates that the equivalent front wheel steering angle variation during the parking process is smooth, without any abrupt changes. Furthermore, as depicted in
Figure 12d, when the vehicle is moving at the maximum allowable parking speed, the variation in the equivalent front wheel steering angle rate along the planned path is steady.
To demonstrate the path planning performance for different parking start points, two additional sets of start coordinates, (3.2, 3.5) and (3.4, 3.7), were proportionally selected based on the initial start point (3.3, 3.6). A quartic polynomial was used for fitting. Due to the coordinate system being rotated counterclockwise by 45°, the heading angle value of 0.7 after rotation corresponds to a heading angle value of 0 before rotation. From
Figure 13a, it can be observed that for the three different start points, the vehicle’s heading angle at both the start and endpoints is 0, meeting the requirement for the vehicle’s initial and final states to be parallel to the parking space. As shown in
Figure 13b, the absolute value of the vehicle’s maximum front wheel steering angle rate for all three paths is 0.403 rad/s, which satisfies the condition of being less than the vehicle’s maximum front wheel steering angle rate of 0.478 rad/s, thus meeting the kinematic constraints.
In summary, the parking path curve based on fourth-degree polynomial planning exhibits excellent tracking performance while ensuring the stability and safety of the parking process under the constraints of vehicle environmental factors, posture, and kinematics.