1. Introduction
With rapid advancements in automotive intelligence, vehicles now provide functionalities beyond basic transportation, driving increased user expectations for safety, convenience, and comfort. As a crucial component of intelligent vehicles, automatic reverse parking (ARP) has garnered extensive attention from both academic and industrial sectors. The effectiveness of ARP systems primarily depends on the accuracy of parking reference trajectory planning and the system’s ability to track and control this trajectory [
1]. To meet users’ parking requirements, it is imperative during the ARP process to ensure that the vehicle does not come into contact with obstacles, while striving for a parking trajectory that is as short and smooth as possible [
2].
A successful ARP operation entails the completion of three critical steps: assessing the feasibility constraints of parking (including detection of available garages), optimizing the acquisition of reference trajectory for parking (trajectory optimization), and executing vehicle tracking control to follow the reference parking trajectory into the designated region (trajectory tracking) [
3]. In recent years, scholars in the relevant field have achieved a series of significant research outcomes concerning the issue of ARP. For the detection of available parking garages, a parking garage identifying method based on deep learning was introduced in [
4]. This approach utilized the Faster R-CNN model, known for its faster training and testing speeds, thus satisfying real-time detection requirements. However, this method could not detect obstacles inside parking garages. A parking detection method based on vehicle occurrence frequency was introduced in [
5].
For automatic parking technology, there is significant focus on the parking detection and tracking control technologies that influence the success rate of parking. However, with an increase in vehicle intelligence, people have higher requirements for the quality of automatic parking trajectory, including collision avoidance, smoothness, and sufficiently short path length. Hence, parking trajectory has garnered increasing attention and has become progressively more mature.
In the field of parking trajectory optimization, various methodologies including geometric programming methods, sampling-based approaches, search algorithms, and numerical optimization techniques have been systematically implemented. A parallel parking path planning framework was developed through three-phase curve interpolation, where cyclotron curves, circular arcs, and quintic polynomial curves were integrated to satisfy narrow spatial constraints in [
6]. The computational efficiency limitations, curvature discontinuity issues, and strict initiating position requirements in automatic parking systems were comprehensively addressed through an enhanced RRT* algorithm with non-linear optimization techniques in [
7]. Furthermore, critical challenges in path planning security and search effectiveness for unmanned parking systems were resolved by a safety-enhanced and efficiency-enhanced hybrid A* algorithm design in [
8]. An optimization scheme for the parallel parking trajectory in automatic parking systems, utilizing the Gaussian collocation pseudospectral method subject to phase constraints, was introduced in [
9]. An optimized parking trajectory planning approach grounded in mirror parking objectives was proposed to resolve challenges including low parking success rates, time-consuming operations, and undefined operational design domains (ODDs) in automatic parking systems for confined garages [
10]. Substantial research efforts have been dedicated in the aforementioned studies to parking trajectory optimization methodologies, with their systematic classification and comparative analysis comprehensively summarized in
Table 1.
To address the issue of potential unnecessary shifting behavior caused by the decoupling of path and speed from the hybrid A* algorithm, a parking trajectory tracking control method coupled with non-linear model predictive control (NMPC) was developed in [
11]. A parking trajectory tracking controller utilizing non-linear model predictive control, which takes into account vehicle dynamics constraints, was introduced in [
12].
Geometric programming methods, hp-pseudospectral methods, gradient descent methods, and dynamic optimization approaches [
13,
14,
15,
16] are limited by poor flexibility, challenges in programming implementation, and a heavy dependence on constraint restrictions. However, these approaches exhibit evident limitations, including poor flexibility, difficulty in programming implementation, and an over-reliance on constraints. To generate a smooth, collision-avoidance parking trajectory for four-wheel steering vehicles, the integration of cubic splines with solving of the optimal control problem was presented in [
17]. To generate a smooth, constraint-satisfying parking trajectory for vehicles in confined parking scenes, the integration of B-spline curves and the gradient descent algorithm was employed to achieve continuous curvature variation and adherence to the vehicle’s minimum turning radius [
18]. Given the high utilization rate of vertical parking garages, the design of a parking garage mostly adopts vertical parking space, and generally utilizes the way of reversing into the vertical parking space. Combining cubic spline interpolation with the intelligent optimization algorithm (IOA), a high-quality algorithm for optimizing automatic parking trajectories can be developed. To address the challenge of automatic parking in vertical parking garage environments, an immune moth–flame optimization algorithm for generating parking trajectories using cubic spline was introduced in [
19]. However, it did not address the handling of infeasible solutions during the parking process, which consequently impacted the overall optimization effectiveness of the parking trajectory.
An improved directional mutation moth–flame optimization algorithm via gene modification (IDMMFO-GM) is proposed in this study. Based on the parking experience and cubic spline interpolation, this study develops a reference trajectory optimization model according to the framework of a standardized parking plane coordinate system. On this basis, this study not only introduces a gene modification method to effectively address infeasible solutions but also proposes an enhanced moth–flame optimization algorithm that incorporates the non-linear decreasing weight coefficient and directional mutation strategy, to significantly enhance the trajectory optimization performance for garage parking.
The organization in this study is as follows:
Section 1 provides the introduction.
Section 2 proposes a reference trajectory optimization model for ARP according to cubic spline theory.
Section 3 details the gene modification mechanism.
Section 4 shows the description of the IDMMFO-GM design.
Section 5 presents the test validation of ARP using an actual vehicle.
Section 6 concludes this study.
2. Optimization Model for Reference Trajectory in ARP
2.1. Fundamental Principles of ARP
The parking behavior of automatically maneuvering vehicles that meets the parking eligibility criteria from the initiating region to the designated parking area is termed as ARP.
Figure 1 illustrates the technical framework for this study.
In the form of ARP, the vehicle that meets the parking conditions in the garage is parked from the initiating region to the permitted parking region. The specific principal schematic principal diagram of ARP is as follows in
Figure 2.
In
Figure 2, we assume that during the ARP process, the region by vehicle body coverage is systematically collected in a sequential order
times, which is recorded as the set of fixed-point regions
. Obviously,
should be the initiating region,
should be the parking region, and
,
, and
are the center points of the fixed-point region, respectively.
is the line of garage bottom,
and
are the near and far boundary lines of the parking garage, respectively, and
,
,
, and
are the near corner and far corner of the garage top, near corner and far corner of the garage bottom, respectively.
represents the reference trajectory for parking, while
denotes the actual trajectory achieved through tracking control [
19].
2.2. Feasibility Constraints Judgment for ARP
ARP is usually required to meet the following conditions: the location of the parking garage must be known, the boundary lines and corner points of the garage should be distinctly discernible, and there are no obstacles inside the parking garage [
20]. In addition, it is necessary to meet the feasibility constraints of the parking garage: the central point
of the parking initiating region should be in the permitted parking region
. The line segment connecting the central point
and the bottom midpoint
of the initiating region is
, and the angle between the line
and the line
of the garage bottom is defined as the initiating tilt angle
, with its absolute value being less than the threshold value
. The constraint equation that determines the feasibility of initiating the parking process in the garage is outlined as follows:
According to the initiating feasibility limitations of the parking garage shown in Formula (1), the initiating tilt angle should be small enough.
2.3. Principles of ARP Coordinate System Conversion
During the automatic parking process, the raw sensor data and system calculations need to be effectively connected through coordinate system alignment. Although the real-world coordinate system constructed from sensor data contains complete parking scene information, it suffers from baseline shift due to differences in sensor installation posture and distortion effects. Therefore, it needs to be converted into a unified standardized coordinate system: Taking the far corner of the parking space as the coordinate origin, extending the x-axis along the bottom line of the parking space, and determining the y-axis through the right-hand rule. This standardized system eliminates sensor deviations through the following three steps (scene extraction, coordinate system rotation, and origin translation), not only establishing a unified spatial reference for multi-source data but also significantly improving the computational efficiency of parking trajectory planning and tracking control. Additionally, it provides a coordinate reference that aligns with human spatial cognition for the visualization interface.
In the standardized Cartesian coordinate system for inbound parking planes, the coordinates of a point are determined to be
. It is straightforward to derive the angle
between this point and the x-axis.
To further obtain the coordinates of this point in the real-world coordinate system, the real-world projection rotation angle detected by the sensor system and the coordinates of the far corner point of the garage bottom in the real-world coordinate system can be substituted in the above reverse-engineer equation.
The real-world coordinates of this point can be obtained from the above reverse-engineer equation. To further obtain the conversion formula from to , the real-world projection rotation angle detected by the sensor system and the coordinates of the far corner point of the garage bottom in the real-world coordinate system can be substituted in the above reverse-engineer equation.
2.4. Optimization Model for Generating the Reference Trajectory in ARP
The parking process cycle is denoted as
, and the detailed optimization model for generating the reference trajectory in ARP is presented below:
where,
is the coverage region of both boundary lines of the garage, and
is the set of the boundary line collision-avoidance detection location points.
is the
-th boundary line collision-avoidance detection location point,
,
is the number of detection location points, obviously
.
,
, and
are the parking interval distance, attitude angle difference, and region by vehicle body coverage in the
-th cycle.
represents the threshold for parking interval distance, and
is the threshold for the difference in attitude angle.
represents the duration of parking, while
denotes the total number of cycles,
,
, and
is the carry up integer operator. During parking maneuvers, all collision detection points must stay outside the vehicle’s coverage area to avoid garage boundary collisions. That is,
. Point
represents the central location of the
-th fixed-point region,
, while region
denotes its corresponding adjustable region, and so
. The variable
signifies the error in parking position,
indicates the threshold for the absolute value of this error, and
corresponds to the ordinate value of the anticipated parking position. Trajectory
serves as the reference path for parking, with its length
being key indicators that substantially influence the quality of parking optimization [
21].
Consider an interval with interpolation points defined within this range, and the cubic spline interpolation function is characterized by the following two properties.
The cubic spline function has two key advantages. First, the function is described by a cubic polynomial in each subinterval, implying that adjustments to a particular subinterval do not affect other subintervals. This locality facilitates the achievement of rapid outcomes when optimizing or adjusting the coordinates of specific region central points, without the need for recalculating the entire trajectory. Then, the cubic spline function is twice continuously differentiable over its entire domain, ensuring the smoothness of curvature variation along the trajectory. This high-order continuity enables the generation of exceptionally smooth curves. Based on these properties, applying cubic spline theory to handle the set of fixed-region centroids enables the quick generation of smooth parking reference trajectories, superior in both aspects to the geometric programming method [
22].
Assuming that the center points’ coordinates of all fixed-point regions within the standardized parking plane system have been acquired, smooth parking reference trajectories can be rapidly generated by cubic spline interpolation fitting. This exhibits a notable advantage over geometric methods.
The algorithm in this study realizes the steering control of the vehicle based on the vehicle kinematics model. The so-called vehicle kinematics model refers to the following:
where
represents the center of the rear axle;
v and
a denote the velocity and acceleration of the vehicle, respectively;
is the heading angle;
is the steering wheel angle;
w is the steering wheel angular velocity;
l is the length between the front and rear wheels, and
t signifies time.
establishes the dynamic relationship between the steering angle
and the change in the heading angle
. The steering angle
directly controls the rate of change of the vehicle’s heading angle
.
To ensure that the trajectory generated during the vehicle’s steering process complies with the mechanical limitations of the vehicle’s steering mechanism, and at the same time meets the steering system’s requirement for continuous changes in the steering wheel angle, the following constraints are added:
where
represents the derivative of the instantaneous curvature.
4. Description of IDMMFO-GM Design
4.1. Introduction to the MFO Algorithm
The MFO algorithm is a swarm intelligence algorithm that was introduced in 2015. This algorithm abstracts the moth’s navigation toward a light source by employing lateral positioning strategies to develop an optimization approach. The MFO algorithm has two important elements: the moth and the flame. The moth is the actual individual in the optimization process, which stands for candidate solution, while the flame symbolizes the optimal solution identified by the moth through the last iteration.
Matrix
M exhibits the location for the moth population:
where
n denotes the overall count of moth individuals, and
d represents the dimensionality of the solution domain.
The fitness values for the moth population are encapsulated in the matrix
:
During the preliminary phase of the algorithm’s iteration process, total flame amount is equivalent to the total number of moth individuals. The initial location of the flame set is denoted through matrix
F:
The fitness value for flame set is denoted through matrix
:
The optimization procedure of the MFO algorithm is summarized by a triplet:
I denotes the algorithm’s initiating operation, which is mainly shown as follows: randomly generating individual moths within the solution domain and subsequently obtaining their respective fitness values.
The association rule for this process is formulated as described below:
P denotes the principal function that guides the moth’s trajectory update once the optimization algorithm initiates its operation. Specifically, the moth adjusts its location according to its own information and that of the flame set, following the logarithmic helical law, and subsequently computes the fitness value of the updated location. If this value surpasses the fitness value of the corresponding flame, the flame’s location is updated accordingly.
The mapping relationship for this process can be described as follows:
T represents the logarithmic helical location adjusting behavior of individual moths. The moth is updated by the logarithmic helical rule as follows:
where
denotes the location of the
i-th moth,
denotes the location of the
j-th flame,
signifies the Euclidean distance location from the
i-th moth to the
j-th flame,
is the variable of altering the location logarithmic helical waveform,
t is a stochastic value within the range of −1 to 1, and
also signifies the logarithmic helical function.
Furthermore, with the rate of algorithm convergence, the quantity of flames will dynamically diminish as the number of iterations increases. The adaptive adjustment mechanism for the flame count is outlined below:
where
represents the number of flames after updating,
l indicates the present iteration count,
denotes the maximum count of flames, and
signifies the upper limit of iterations allowed.
4.2. Non-Linear Decreasing Strategy of Weight Coefficient
To achieve a more effective balance between global and local searching, a non-linear decreasing approach for the weight coefficient associated with the logarithmic helical term is introduced in this study. This approach aims to address the inherent limitation of the moth–flame optimization, which is prone to converging prematurely to local optima. The specific mapping expression for the logarithmic helical location adjusting behavior of the moth individual is as follows:
When the weight coefficient is higher, the algorithm exhibits significant global searching performance, which is particularly appropriate for the preliminary phase of the optimization procedure. Conversely, when the weight coefficient is lower, the algorithm demonstrates enhanced local searching. In this study, we propose a non-linear decreasing approach about the flexible weight coefficient and propose it relying on the cosine structure.
The specific non-linear decreasing function about the weight coefficient
of iteration progress
is presented in
Figure 5.
The specific formula for calculating the weight coefficient
is presented as follows:
where
represents the weight coefficient decrement,
, and
and
denote the lower and upper limits of the weight coefficients, respectively.
signifies the progression of the iteration,
, and
is the optimization factor for the non-linear decreasing about the weight coefficient
.
As illustrated in
Figure 5, the cosine structure non-linear decreasing strategy exhibits significant adaptability and flexibility. Specifically, this strategy is employed to optimize and adjust the weight coefficient by selecting the most appropriate optimization parameter; hence, it enables real-time adjustment of the weight coefficient decreasing rate during the iterative process, which is conducive to the improvement in the balance effect between global exploration and local development, to improve the overall optimization ability of the algorithm [
23].
4.3. Directional Mutation Strategy
At the end of the optimization of the MFO algorithm, the moth population is easily affected by the flame set, thus leading a high risk of local convergence. By introducing the mutation operator of the genetic mechanism, the diversity of the moth population can be significantly enhanced, to reduce the risk of the algorithm falling into local convergence. Compared with traditional random mutation based on a certain mutation probability, directional mutation guided by gradient information significantly enhances the convergence speed and optimization precision of the algorithm.
The specific process of directional mutation in parking reference trajectory optimization is outlined as follows:
Parking reference trajectory optimization is a specific type of optimization problem aimed at minimizing a single objective. Generally, this class’s problems can be formally described as follows:
where
y represents the optimization objective,
u denotes the decision variable, and
signifies the optimization mapping model for solving the optimization objective
y of decision variable
u. For the parking reference trajectory optimization problem, the decision variable
u is defined as the center point set
of the fixed-point region to be decided,
, while the objective function
represents the length
of the reference trajectory.
The original decision variable to be directed mutation is denoted as
, the gene inheritance decision variable for directional mutation is denoted as
, and the gene changing decision variable for directional mutation is denoted as
. Subsequently, the directed vector
can be formally defined as follows:
where
represents a symbolic function that denotes the sign of the parameters, including 0, −1, and 1.
If , the vector represents the evolutionary direction of objective function from the gene inheritance decision variable to the gene changing decision variable . Conversely, the vector denotes its degenerate direction. Gene inheritance decision variable usually selects the original decision variable or its direct parent, while selecting the gene changing decision variable, it should be chosen to be as far as possible from the original decision variable .
Through the application of direction vector
, the directional mutation of the original decision variable
can be carried out. The specific formulation is as follows:
where
represents the original decision variable to be directed mutation,
denotes the updated decision variable after directional mutation, and
signifies the adjustment coefficient for directional mutation,
.
It is assumed that at the i-th iteration, the i-th moth in the current moth population is to be directed mutation, and it is taken as the gene inheritance decision variable, and the j-th flame in flame set is randomly selected as the gene changing decision variable of its directional mutation. The gene inheritance decision variable determined by moth is denoted as , while the gene changing decision variable determined by flame is represented as . The fitness values of moth and flame are denoted as and , respectively, and directional mutation can be achieved.
According to the above formulas, by regulating the directional mutation adjustment coefficient , the global and local exploration of the algorithm can be more effectively balanced, to promote the whole effect of the algorithm.
Specifically, the flowchart for IDMMFO proposed in this study is shown in
Figure 6.
5. Test Verification
5.1. Description of the Test Scene for ARP
In this study, the ARP scene of space No.155 in the garage of Dalian Shell Museum, which is situated within Dalian Xinghai Square, was selected as the actual parking test site. The lengths of the near boundary and far boundary lines for the test garage were identical, both of which were 5 m in length. To carry out engineering validation of the IDMMFO-GM strategy introduced in this study, a series of actual vehicle tests were performed using a designated test vehicle. The test vehicle model was the Toyota Corolla 1.2T S-CVT GL Pioneer Edition (2019 model year), measuring 4635 mm in length, 1780 mm in width, and 1455 mm in height. This vehicle was equipped with an ETRS electronic transmission system and an EPS electric power steering system, thus enabling automated control of steering, acceleration, braking, and gear shifting. The distances along the horizontal and vertical, measured from the bottom right corner of the test vehicle’s initiating region to the nearby top corner of the parking garage, were 2.0 m and 2.1 m, respectively.
5.2. Development and Settings of ARP Test
This study employed a test vehicle outfitted with the ARP system, incorporating a real-time MPC555LFMZP40 trajectory optimizer and trajectory controller chip, as well as a DSP28335 auxiliary control unit and data awareness system. Additionally, the system included an execution drive unit chip and various essential actuators. The data awareness system mainly comprised a surround-view camera for detecting parking garage information, a radar for obstacle avoidance, and a camera controller for analyzing the data collected by the surround-view camera. Additionally, the system included an execution drive unit chip and various essential actuators. During the ARP process, the vehicle’s driver monitored real-time braking status via the ARP monitoring upper computer without interfering with the normal ARP operations. Only when necessary, the driver can apply the braking instruction or emergency braking parking instruction to make the test vehicle park or for emergency braking. The overall design diagram of the ARP test is displayed in
Figure 7.
The main settings for the ARP test adopted in this study are outlined as follows: data acquisition for braking, assessment of parking feasibility, optimization of reference trajectory, tracking control of reference trajectory, emergency braking, and braking time limits. The limit time of each process was 3.5 s, 1.5 s, 10 s, 25 s, 0.4 s, and 1.5 s, respectively. At least one ARP driver holding a C2 driving qualification in the vehicle, one external safety inspector, and one skilled unmanned aerial photographer should be equipped; the unmanned aerial camera used was the DJI “Royal” Mavic 2; the ARP monitoring host computer was configured with a “MacBook Pro 2016 Core i5 @ 2.9 GHz”; and the communication was carried out by Bluetooth on board.
The ARP procedure integrates five stages: environmental sensing, feasibility assessment, trajectory optimization, fuzzy PID control, and emergency braking. Radar and Around View Monitor (AVM) data fusion ensured stability in complex scenarios. The data awareness system of the test vehicle utilized multi-sensor fusion technology, and it mainly comprises a surround-view camera for detecting parking garage information, radar for obstacle avoidance, and a camera controller for analyzing the data collected by the surround-view camera. The data awareness system is composed of a ring array of 12 ranging radars and an AVM system equipped with four high-precision cameras. Specifically, eight radars are positioned on the sides of the front and rear bumpers, while the other four are mounted on the front bumper; the radar array precisely identifies obstacles and delineates parking space contours via a comprehensive monitoring network. The AVM system employed wide-angle cameras located at the bottom of the front grille, license plate lights, and rearview mirrors to capture images, which were subsequently transmitted via CVDS or LVDS. It then produced a switchable 2D/3D panoramic view without black edges by applying fisheye correction and multi-perspective stitching techniques. The system’s design incorporates an overlapping field of view and a dynamic compensation mechanism, which can tolerate up to a assembly error. Additionally, an automatic rotation mechanism is employed to address image offset caused by vehicle vibrations.
5.3. Test Results and Comparative Analysis from ARP
Based on an actual ARP scene, this study employed four advanced optimization algorithms to refine the parking reference trajectory for improved performance. Specifically, the following algorithms were applied: the improved directional mutation moth–flame algorithm via gene modification (IDMMO-GM) proposed in this study, an enhanced immune MFO algorithm according to gene correction (IIMFO-GC) [
24], an improved particle swarm optimization algorithm (IPSO) [
20], and an enhanced immune shark smell optimization algorithm (IISSO) [
21]. Additionally, these algorithms uniformly employed fuzzy proportional–integral–derivative (PID) control to achieve precise reference trajectory tracking. To ensure an impartial comparison, the ARP reference trajectory optimization model utilizing the aforementioned algorithms all employed identical parameter settings, as detailed in
Table 2. The parameter settings for IDMMFO-GM applied in the ARP reference trajectory optimization model are presented in
Table 3.
To achieve a fair comparison of the four optimization algorithm, three designated fixed-point regions (
,
,
) were selected, where
,
, and
. The detailed results of ARP optimization and tracking control are presented in
Table 4,
Table 5,
Table 6 and
Table 7. The specific optimization trajectories and tracking control curves for the ARP system, as monitored by the host computer, are depicted in
Figure 8 and
Figure 9. The designated fixed-point regions’ curves for ARP trajectory optimization and tracking control, as determined by the host computer monitoring, are presented in
Figure 10 and
Figure 11. An actual unmanned aerial image of the fixed-point regions for ARP trajectory tracking control is shown in
Figure 12.
As illustrated in
Figure 8, compared with the three optimization algorithms used for comparison, IDMMFO-GM shows superior optimization performance in obtaining an ideal reference trajectory, and it exhibits a shorter path length and a smaller expected berthing tilt angle in its reference trajectory. As depicted in
Figure 9, the IDMMFO-GM algorithm demonstrates higher tracking control performance when employing the fuzzy PID tracking algorithm. Consequently, the resulting trajectory exhibits a reduced path length and a smaller actual berthing tilt angle. As shown in
Figure 10, compared with the three optimization algorithms used for comparison, the IDMMFO-GM algorithm exhibits better optimization performance in generating an optimal reference trajectory. The trajectory produced by IDMMFO-GM not only approaches the garage’s boundary line more closely but also results in a reduced expected berthing tilt angle. As displayed in
Figure 11 and
Figure 12, the IDMMFO-GM algorithm describes enhanced tracking control performance when using the fuzzy PID algorithm. The resulting trajectory is nearer to the garage’s boundary line and exhibits a smaller actual berthing tilt angle. In
Figure 11, the IDMMFO-GM algorithm aligns the vehicle toward the right side of the parking garage. Specifically, the x-axis coordinate of the vehicle’s final parking position is greater compared to that achieved by other algorithms. Consequently, with the same initiating region, the IDMMFO-GM algorithm demands the least land area, significantly minimizing the construction and operational costs associated with parking facilities. On the other hand, a more to the right position results in a shorter path length. As the vehicle maintains an approximately steady speed while parking, this indicates that the vehicle will require less stopping time, thus enhancing the users’ overall experience.
Table 4 and
Table 5 indicate that IDMMFO-GM surpasses the three comparative algorithms in both reference and actual trajectories. Specifically, it results in a reduced reference trajectory length. Moreover, when the fuzzy PID tracking algorithm is employed, it achieves a shorter actual trajectory length in tracking control. As presented in
Table 6, compared with the three optimization algorithms used for comparison, IDMMFO-GM demonstrates a notably smaller expected berthing tilt angle in its reference trajectory. Furthermore, when employing the same tracking control algorithm (fuzzy PID), it achieves a significantly smaller actual berthing tilt angle in its actual trajectory. As illustrated in
Table 7, in comparison with the other three algorithms, IDMMFO-GM exhibits a markedly shorter optimization time requirement. Moreover, when utilizing the same fuzzy PID control algorithm, it further attains a significantly reduced tracking control time.
5.4. Simulation Results and Comparative Analysis from ARP
To further validate the effectiveness of the proposed algorithm, simulation verification for ARP trajectory optimization and actual tracking control was conducted using the Matlab simulation platform. A monitoring platform based on Visual Studio was employed to monitor the entire ARP trajectory optimization process, with communication established using Visual C++ 6.0 and the communication medium being Office Excel. The simulation environment was configured as follows: Matlab version 2016b, Visual Studio version VS2015, computer processor model Core i7-9800X @ 3.80 GHz, and Office Excel version Office Excel 2017. The ARP-optimized trajectory model based on Matlab simulation and the key parameters of IDMMFO-GM are described in
Table 2 and
Table 3, respectively. The pchip function was utilized to construct the cubic spline interpolation function, while the integral fitting method was adopted to solve parking curve length calculations.
This study selected parking space No. 155 at Dalian Shell Museum in Xinghai Square, Dalian, as the test scenario for automatic parking. The lengths of both the near-side and far-side boundary lines of the test garage were measured as 5.0 m, while the length of the rear boundary line was recorded as 2.7 m, with the width of the parking space markings being 0.1 m. The test vehicle used was a Volkswagen Tiguan (2016 model, 1L variant), with its length, width, and height being specified as 3540 mm, 1645 mm, and 1509 mm, respectively. The initiating position of the vehicle was such that the horizontal distance between the bottom right corner of its coverage area and the far corner of the parking space was measured as 2.2 m, while the longitudinal distance was recorded as 1.0 m.
Under the aforementioned simulation conditions, comparative tests were conducted between the proposed IDMMFO-GM and three algorithms: IIMFO-GC, IISSO, and IPSO. The trajectory optimization simulation curves and related results are presented in
Figure 13 and
Table 8.
As illustrated in
Figure 13 and
Table 8, compared with IIMFO-GC, IISSO, and IPSO, the simulation-optimized trajectory obtained through IDMMFO-GM demonstrates a shorter berthing trajectory length, and closer proximity to the garage’s near-side boundary line. This indicates that the proposed IDMMFO-GM possesses superior optimization capabilities, enabling the identification of more desirable parking trajectories and achieving enhanced ARP trajectory optimization outcomes.
6. Conclusions
ARP systems have a broad spectrum of practical applications across various fields including commercial, civilian, military, and ceremonial domains. However, trajectory optimization for ARP systems presents a multi-objective, non-linear, and extremely difficult optimization challenge. Consequently, obtaining an ideal reference trajectory that makes its curve collision-avoidance smoothness and short path lengths, is particularly difficult. To effectively enhance the performance of ARP trajectory optimization, a gene modification optimization algorithm, IDMMFO-GM, is proposed in this study. In contrast to current research achievements on optimizing reference trajectories for automatic parking, the key contributions of this study can be summarized as follows:
A novel reference trajectory optimization model for ARP is developed. Integrating cubic spline interpolation with the standardized parking plane coordinate system, an effective and practical reference trajectory optimization framework is established, which takes into account the feasibility constraints of parking, including the initiating region and berthing tilt angle; hence, it can effectively describe and optimize ARP trajectory.
To address the issue of infeasible solutions and balance the algorithm’s global exploitation and local development capabilities, an IDMMFO-GM is introduced. This algorithm organically integrates the gene modification mechanism, the non-linear decreasing weight coefficient strategy, and the directional mutation strategy, which can effectively utilize infeasible solutions encountered during computation, thus improving its global optimization performance and avoiding local convergence.
While the IDMMFO-GM algorithm exhibits excellent performance in optimizing automatic parking trajectories, it still possesses certain constraints: (I) Concerning parameter sensitivity, the algorithm’s empirical coefficients require manual tuning. This not only raises deployment expenses but might also compromise the algorithm’s adaptability in parking scenes. To achieve dynamic parameter adjustment, the implementation of online calibration technology is essential. (II) Regarding the constraint of dynamic adaptability, the current research is primarily grounded in the static environment hypothesis and does not account for real-time interference factors such as pedestrian movement and dynamic obstacles. In future work, mechanisms for predicting and avoiding dynamic obstacles will be incorporated. (III) Considering the sensitivity of sensor errors, the precision of transforming into a standardized coordinate system largely relies on the quality of sensor calibration. This reliance becomes more significant under extreme conditions, such as low light or adverse weather like rain and snow, where error accumulation is more likely to occur. Therefore, adopting a multi-source sensor fusion approach is essential for enhancing the stability of the system. (IV) At the multi-objective optimization level, the current model focuses solely on path length as its optimization goal and does not adequately account for various factors, including the rate of change in steering angle and energy consumption efficiency. This could result in practical issues, such as decreased comfort during application. Moving forward, the integration of multi-objective optimization algorithms will aim to address and harmonize the diverse performance requirements across dimensions.
To validate the efficacy of the proposed IDMMFO-GM, an automatic parking test is conducted for verification. Actual vehicle tests show that IDMMFO-GM outperforms three high-performance comparative optimization algorithms in parking trajectory optimization. Additionally, its trajectory tracking control performance is markedly improved.