Automatic parking track planning method, electronic equipment and vehicle
By constructing and verifying the elliptical arc trajectory in the automatic parking system and directly controlling the parking of vehicles, the problems of large amount of calculation and long parking time in the prior art are solved, and a faster and smoother parking process is achieved.
Patent Information
- Application Number
- CN202411174807.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-26
- Publication Date
- 2024-11-15
AI Technical Summary
The existing automatic parking trajectory planning and calculation volume are large, resulting in long parking time and affecting the user experience.
Multiple elliptical arc trajectories are constructed based on the docking inflection point, and the target elliptical arc trajectory is determined through test verification, eliminating the smoothing process step, and directly controlling the vehicle to park based on the target elliptical arc trajectory.
It reduces the amount of calculation, saves parking trajectory planning time, shortens vehicle parking time, improves user experience, and has a smooth parking process.
Smart Images

Figure CN118953340A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of vehicle technology, and in particular to an automatic parking trajectory planning method, electronic equipment and a vehicle. Background Art
[0002] Automatic parking is an important function in autonomous driving. Existing automatic parking trajectories require the integration of multiple algorithms, which requires large amounts of calculations and long parking times, affecting user experience and need to be improved. Summary of the invention
[0003] In view of this, the purpose of the present application is to propose an automatic parking trajectory planning method, electronic equipment and vehicle to solve the problems of large amount of calculation and long parking time in the existing automatic parking trajectory planning.
[0004] Based on the above objectives, the present application provides an automatic parking trajectory planning method, including:
[0005] Determine a parking-out inflection point interval based on the acquired parking-out starting point, wherein the parking-out inflection point interval includes a plurality of parking-out inflection points;
[0006] Constructing a plurality of parking-out elliptical arc trajectories based on at least one of the parking-out inflection points; in response to determining that there is a parking-out elliptical arc trajectory that passes the test verification, determining the parking-out elliptical arc trajectory that passes the test verification as a target elliptical arc trajectory;
[0007] The vehicle is controlled to park based on the target elliptical arc trajectory.
[0008] Based on the same inventive concept, the present disclosure also provides an electronic device, including a memory, a processor, and a computer program stored in the memory and executable by the processor, wherein the processor implements the method as described above when executing the computer program.
[0009] Based on the same inventive concept, the present disclosure also provides a vehicle, which includes any of the automatic parking trajectory planning systems described above and the above-mentioned electronic device.
[0010] As can be seen from the above, the automatic parking trajectory planning method, electronic device and vehicle provided by the present application, wherein in the method, in the drivable area, a parking elliptical arc trajectory is constructed based on at least one determined parking inflection point, and after a parking inflection point is determined in the parking inflection point interval, multiple parking elliptical arc trajectories passing the parking inflection point are constructed, and the multiple elliptical arcs are tested and verified, and the parking elliptical arc trajectory that passes the test verification is determined as the target elliptical arc trajectory, and the vehicle is controlled to park based on the target elliptical arc trajectory. The parking elliptical arc trajectory is the key trajectory for the vehicle to park out of the parking space. And the curvature of each trajectory point on the target elliptical arc trajectory changes gradually, which is smooth in itself, and there is no need to use an algorithm for smoothing, that is, the time for smoothing is saved, and the parking time is saved. This embodiment uses a pure geometric algorithm to design an elliptical arc parking trajectory, and the entire parking trajectory does not involve sudden changes in curvature, does not need to be smoothed, does not need to increase the number of rubbing the library, reduces the amount of calculation, saves the parking trajectory planning time, and thus shortens the vehicle parking time, and the parking process is smooth, which improves the user experience. BRIEF DESCRIPTION OF THE DRAWINGS
[0011] In order to more clearly illustrate the technical solutions in the present application or related technologies, the drawings required for use in the embodiments or related technical descriptions are briefly introduced below. Obviously, the drawings described below are only embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0012] Figure 1 The following is a flow chart of the automatic parking trajectory planning method according to an embodiment of the present application. Figure 1 ;
[0013] Figure 2 The following is a flow chart of the automatic parking trajectory planning method according to an embodiment of the present application. Figure 2 ;
[0014] Figure 3 The following is a flow chart of the automatic parking trajectory planning method according to an embodiment of the present application. Figure 3 ;
[0015] Figure 4 The following is a flow chart of the automatic parking trajectory planning method according to an embodiment of the present application. Figure 4 ;
[0016] Figure 5 The following is a flow chart of the automatic parking trajectory planning method according to an embodiment of the present application. Figure 5 ;
[0017] Figure 6 This is a schematic diagram of a vehicle coordinate system based on a vertical parking space according to an embodiment of the present application;
[0018] Figure 7This is a schematic diagram of a vehicle coordinate system based on an inclined parking space according to an embodiment of the present application;
[0019] Figure 8 A schematic diagram of multiple parking elliptical arc trajectories constructed based on a parking inflection point in an embodiment of the present application;
[0020] Fig. 9 A schematic diagram of a parking trajectory of a vehicle parked out of a vertical parking space according to an embodiment of the present application;
[0021] Fig.10 A schematic diagram of a parking trajectory of a vehicle parked out of an inclined parking space according to an embodiment of the present application;
[0022] Fig.11 This is a schematic diagram of a state in which an obstacle spacing line and a boundary parking trajectory of a vehicle on the driver's side overlap in an embodiment of the present application;
[0023] Fig.12 This is a schematic diagram of a state in which an obstacle spacing line and a boundary parking trajectory of the passenger side vehicle overlap in an embodiment of the present application;
[0024] Fig.13 A schematic diagram of the positions of the boundary lines and spacing lines of obstacles in an embodiment of the present application;
[0025] Fig.14 A schematic diagram of an automatic parking trajectory planning device according to an embodiment of the present application;
[0026] Fig.15 A schematic diagram of an electronic device according to an embodiment of the present application.
[0027] In the figure, 1, drivable area; 11, lane line; 2, vehicle; 3, vertical parking space; 4, inclined parking space; 5, obstacle; 51, boundary line; 52, spacing line; a, parking elliptical arc trajectory; b, driver side boundary parking trajectory; c, passenger side boundary parking trajectory; S1, starting straight line trajectory; S2, target parking elliptical arc trajectory; S3, ending straight line trajectory. DETAILED DESCRIPTION
[0028] In order to make the objectives, technical solutions and advantages of the present application more clearly understood, the present application is further described in detail below in combination with specific embodiments and with reference to the accompanying drawings.
[0029] It should be noted that, unless otherwise defined, the technical terms or scientific terms used in the embodiments of the present application should be the usual meanings understood by people with ordinary skills in the field to which the present application belongs. The "first", "second" and similar words used in the embodiments of the present application do not represent any order, quantity or importance, but are only used to distinguish different components. "Including" or "comprising" and similar words mean that the elements or objects appearing in front of the word cover the elements or objects listed after the word and their equivalents, without excluding other elements or objects. "Connect" or "connected" and similar words are not limited to physical or mechanical connections, but can include electrical connections, whether direct or indirect. "Up", "down", "left", "right" and the like are only used to indicate relative positional relationships. When the absolute position of the described object changes, the relative positional relationship may also change accordingly.
[0030] It should be noted that in the related art, vehicle parking spaces are divided into three types: inclined parking spaces 4, parallel parking spaces, and vertical parking spaces 3. For example, the inclined length of the inclined parking space 4 is 6 meters, the width is 2.8 meters, and the vertical distance between the two oblique lines is 2.5 meters; the size of the parallel parking space is 6 meters long and 2.5 meters wide; the size of the vertical parking space 3 is 6 meters long and 2.5 meters wide. This application is to improve the path planning of the parking exit scene of the vehicle parked in the inclined parking space 4 or the vertical parking space 3.
[0031] In the related art, in the planning of parking trajectories, a hybrid A* algorithm and ReedShepp (RS) curve algorithm are generally used to plan a rough trajectory and find a reference solution without collision. Although the hybrid A* algorithm and RS curve planning algorithm meet the vehicle kinematic constraints, the trajectories they plan are composed of multiple arcs and straight lines. There are some sudden changes in curvature at the locations where arcs and arcs connect with straight lines. Therefore, such paths also need to design smoothing algorithms, such as IAPS (Iterative Anchoring Path Smoothing), O-ABC (Particle Swarm Optimization-Artificial Bee Colony), etc., to further smooth the process to meet the requirements of control and ride comfort. Therefore, the setting and superposition of multiple algorithms require relatively high computing power for the controller.
[0032] In addition, in the simulation experiment, for the scenario of parking out of vertical parking space 3, the trajectory generated by the hybrid A* algorithm and RS curve algorithm will have at least two parking errors due to the sudden change in curvature, that is, at least two setbacks. The planning algorithm in this scenario takes a long time to park out of vertical parking space 3, which affects the user experience.
[0033] Based on the above problems, the applicant found that for the scene where the vehicle is parked out of the inclined parking space 4 or the vertical parking space 3, it is possible to abandon the use of the hybrid A* algorithm, RS curve planning algorithm, IAPS and OABC algorithms, and instead use a pure geometric algorithm to design an elliptical arc trajectory, that is, there is no need to increase the number of parking rubbing times, and a complete trajectory can achieve the parking function of the inclined parking space 4 or the vertical parking space 3. And the elliptical arc itself is smooth, which saves the step of trajectory smoothing, reduces the amount of calculation, shortens the parking trajectory planning time, and improves the user experience.
[0034] The embodiments of the present application are described in detail below with reference to the accompanying drawings.
[0035] In some embodiments, reference Figure 1 , an automatic parking trajectory planning method, the parking space is an inclined parking space 4 or a vertical parking space 3, the method is executed by a vehicle controller or a server independent of the vehicle controller, for the convenience of description, the embodiments of the present application are all described by taking the vehicle controller executing the method as an example, the method includes:
[0036] S101. Determine a parking-out inflection point interval based on an acquired parking-out starting point, wherein the parking-out inflection point interval includes a plurality of parking-out inflection points.
[0037] For example, the drivable area 1 can be obtained through a vehicle camera or a parking space camera connected to a vehicle controller. The drivable area 1 can be added with a lane line 11 during the simulation process. The axis passing through the front and rear directions of the vehicle 2 is used as the y-axis, and the straight line passing through at least one end of the parking space exit and parallel to the lane line 11 in the drivable area 1 is used as the x-axis. The direction pointing to the front of the vehicle is used as the positive axis of the y-axis, and the right side of the vehicle is used as the positive axis of the x-axis. A vehicle coordinate system is established in the drivable area 1. For a vertical parking space 3, the vehicle coordinate system is a rectangular coordinate system, such as Figure 6 As shown, for the inclined parking space 4, the vehicle coordinate system is an oblique coordinate system, such as Figure 7 shown.
[0038] The parking starting point may be the midpoint of the rear axle of the vehicle in the vehicle coordinate system, such as Figure 6 , Figure 7 The M point in .
[0039] The parking inflection point is the inflection point when the midpoint of the rear axle of the vehicle is parked out of the parking space, and is also the starting point of the elliptical arc trajectory, located on the y-axis. Figure 6 , Figure 7 The end point of the elliptical arc trajectory is the target point after the vehicle leaves the parking space, such as Figure 6 , Figure 7For point R in the figure, if you turn right from the parking space, the end point of the arc is in the first quadrant of the vehicle coordinate system. If you turn left from the parking space, the end point of the arc is in the second quadrant of the vehicle coordinate system.
[0040] For the vertical parking space 3, the parking inflection point interval can generally be set to be an interval with the rear axle midpoint and the coordinate origin as the two end points. For example, Figure 6 As shown, the parking turning point interval is an interval with point M and point O as the two end points. For the inclined parking space 4, the parking turning point interval can generally be set to an interval with the center point of the rear axle and the center point of the y-axis between the two lane lines 11 as the two end points. For example, Figure 7 As shown, the inflection point interval is an interval with point M and point Z as the two end points.
[0041] S102, constructing a plurality of parking-out elliptical arc trajectories based on at least one of the parking-out inflection points; in response to determining that there is a parking-out elliptical arc trajectory that passes the test verification, determining the parking-out elliptical arc trajectory that passes the test verification as a target elliptical arc trajectory.
[0042] For the vertical parking space 3, the parking elliptical arc trajectory is a quarter of an elliptical arc starting from the parking turning point. For the inclined parking space 4, the parking elliptical arc trajectory is an elliptical arc smaller than a quarter of an elliptical arc starting from the parking turning point. The elliptical arc is based on the pre-stored minimum turning radius R min And the ellipse parameters are determined, wherein the ellipse parameters are the major semi-axis a or the minor semi-axis b, and the ellipse parameters are determined based on actual vehicle tests.
[0043] Wherein, constructing a plurality of parking-out elliptical arc trajectories based on at least one parking-out inflection point comprises:
[0044] S102a, obtaining the minimum turning radius R of the vehicle min , based on the minimum turning radius R min Determine the maximum curvature K max .
[0045] Among them, the minimum turning radius of the vehicle refers to the radius of the circle of the track that the center of the outer steering wheel rolls on the supporting plane when the steering wheel is turned to the extreme position and the vehicle is turning at the lowest stable speed. The minimum turning radius of the vehicle largely characterizes the ability of the vehicle to pass through narrow curved areas or bypass insurmountable obstacles 5. The smaller the turning radius, the better the maneuverability of the vehicle. The minimum turning radius of the vehicle is generally set according to the vehicle's wheelbase, track and the maximum turning angle of the steering wheel, which is a factory setting parameter for the vehicle. Of course, the minimum turning radius can also be set by the user according to the actual situation of the vehicle. For example, the minimum turning radius of the vehicle is 4.5m-5.5m. Specifically, R min =4.7m.
[0046] Among them, the minimum turning radius R min and the maximum curvature K max are reciprocals of each other. For example, K max =1 / 4.7=0.2128.
[0047] It should be noted that in order to ensure vehicle safety, the vehicle's actual maximum turning curvature cannot be used for calculation. A safety buffer value can be subtracted and then calculated to obtain a slightly smaller maximum turning curvature.
[0048] S102b, based on the pre-stored ellipse parameters and the maximum curvature K max Constructing a parking-out elliptical arc trajectory passing through the parking-out inflection point;
[0049] Specifically, K max =a / b 2 For example, based on the actual vehicle test, the value range of b can be 4.88m-5.20m, and four short semi-axle data of 4.88, 5.00, 5.10, and 5.20 are pre-stored. max =0.2128, the corresponding values of the major semi-axis a are 5.08, 5.32, 5.53, and 6.09. Then, in the vertical coordinate system, based on each inflection point, four quarter-ellipse arcs can be constructed with the inflection point as the starting point, such as Figure 8 As shown, the major semi-axis and minor semi-axis combinations of the four elliptical arcs are (5.08, 4.88) (5.32, 5.00) (5.53, 5.10) (6.09, 5.20) respectively.
[0050] After constructing a plurality of parking elliptical arc trajectories, the plurality of parking elliptical arc trajectories are tested and verified. The test and verification may be a conventional collision verification. The parking elliptical arc trajectories that pass the test and verification are determined as target elliptical arc trajectories.
[0051] The collision check process includes:
[0052] An obstacle boundary line and a vehicle boundary parking trajectory corresponding to the parking elliptical arc trajectory are determined within the drivable area; in response to determining that there is an overlapping portion between the obstacle boundary line and the vehicle boundary parking trajectory, determining that the collision check has failed; in response to determining that there is no overlapping portion between the obstacle boundary line and the vehicle boundary parking trajectory, determining that the collision check has passed.
[0053] The obstacle may be a wall, another vehicle, a stone, etc., and may be determined by a vehicle camera or a parking space camera connected to the vehicle controller. The boundary line of the obstacle is obtained by expanding the corresponding preset safety distance based on the size of the obstacle itself. For example, if the length and width of an obstacle are both 1.2m, and the preset safety distance is 0.3m, then the length and width of the boundary line of the obstacle are both 1.5m.
[0054] S103: Control the vehicle to park based on the target elliptical arc trajectory.
[0055] It should be noted that, in the general case of a vehicle parking out of a parking space in the vehicle coordinate system, the vehicle first travels a straight line trajectory along the positive direction of the y-axis from the parking starting point M (hereinafter referred to as the starting straight line trajectory, such as Fig. 9 , Fig.10 S1 track in the target head) to the turning point S, and then follow the arc track of the target head (such as Fig. 9 , Fig.10 The vehicle then drives along the S2 trajectory in the figure to the end point R of the arc, and then drives along a straight line trajectory parallel to the x-axis (hereinafter referred to as the terminal straight line trajectory, such as Fig. 9 , Fig.10 The complete parking trajectory is determined as follows:
[0056] Based on the parking start point and the parking elliptical arc trajectory, a starting straight line trajectory and a terminating straight line trajectory are determined, and the starting straight line trajectory, the parking elliptical arc trajectory and the terminating straight line trajectory are spliced into a parking trajectory and output. The target parking elliptical arc trajectory includes an arc start point and an arc end point, the heading of the starting straight line trajectory is the same as the heading of the arc start point, and the heading of the arc end point is the same as the heading of the terminating straight line trajectory.
[0057] The starting point of the arc is the turning point of the vehicle leaving the parking space, and the end point of the arc is the end point of the elliptical arc track after the vehicle leaves the parking space. The line connecting the starting point of the parking and the starting point of the arc is the starting straight line track, and the line connecting the end point of the arc and the end point of the parking (the end point of the parking can be a point with a preset distance from the end point of the arc, for example, the end point of the parking is a point 1m away from the end point of the arc) is the ending straight line track. The starting straight line track, the parking elliptical arc track and the ending straight line track are spliced to determine the parking track, and the parking track can be output and displayed on the vehicle screen.
[0058] In addition, the headings of the trajectory points involved in this application all represent the driving direction from the center point of the rear axle of the vehicle to the corresponding trajectory point during the vehicle's driving along the trajectory. The heading of the starting straight line trajectory is the same as the heading of the starting point of the arc, that is, both point to the exit direction of the parking space, and the heading of the end point of the arc is the same as the heading of the ending straight line trajectory, that is, both are parallel to the lane line 11 in the drivable area 1, thereby ensuring that the entire parking trajectory is smooth.
[0059] In this embodiment, within the drivable area 1, a parking elliptical arc trajectory is constructed based on at least one determined parking inflection point. After a parking inflection point is determined in the parking inflection point interval, multiple parking elliptical arc trajectories passing the parking inflection point are constructed, and the multiple elliptical arcs are tested and verified. The parking elliptical arc trajectory that passes the test and verification is determined as the target elliptical arc trajectory, and the vehicle is controlled to park based on the target elliptical arc trajectory. The parking elliptical arc trajectory is the key trajectory for the vehicle to park out of the parking space. Moreover, the curvature of each trajectory point on the target elliptical arc trajectory changes gradually, which is smooth in itself, and there is no need to use an algorithm for smoothing, that is, the time for smoothing is saved, and the parking time is saved. In this embodiment, a pure geometric algorithm is used to design an elliptical arc parking trajectory. The entire parking trajectory does not involve sudden changes in curvature, and there is no need to perform smoothing. There is no need to increase the number of rubbing the library, which reduces the amount of calculation, saves the parking trajectory planning time, and thus shortens the vehicle parking time. The parking process is smooth, which improves the user experience.
[0060] The above embodiment is a process of constructing multiple parking out inflection points based on the parking out inflection points, and determining the target elliptical arc trajectory from the multiple parking out inflection points through testing and verification. The following embodiment further explains how to determine the appropriate parking out inflection point within the parking out inflection point interval, and how to determine the target elliptical arc trajectory through testing and verification. Moreover, the following embodiment is more suitable for the situation where the total number of parking out inflection points is large.
[0061] In some embodiments, S102 constructs a plurality of parking elliptical arc trajectories based on at least one of the parking inflection points; in response to determining that there is a parking elliptical arc trajectory that passes the test verification, the parking elliptical arc trajectory that passes the test verification is determined as the target elliptical arc trajectory, and Figure 2 , further comprising:
[0062] S201, dividing the parking-out inflection point interval into a plurality of sub-intervals.
[0063] S202: Determine the parking-out inflection point between adjacent sub-intervals as a primary parking-out inflection point, and determine the parking-out inflection point within a sub-interval as a secondary parking-out inflection point.
[0064] S203: Determine an initial iteration inflection point among a plurality of first-level inflection points or second-level inflection points.
[0065] S204: construct multiple initial elliptical arc trajectories based on the initial iterative turning point, and test and verify each of the initial elliptical arc trajectories.
[0066] S205 . In response to determining that there is an initial parked elliptical arc trajectory that passes the test verification, determine the initial parked elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory.
[0067] S206: Determine a target sub-interval within a plurality of sub-intervals based on the initial iterative inflection point.
[0068] S207: construct a plurality of interval parking-out elliptical arc trajectories based on at least one of the secondary parking-out inflection points in the target sub-interval, and test and verify each of the interval parking-out elliptical arc trajectories.
[0069] S208. In response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, determine the interval parking elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory.
[0070] S209: Determine a target elliptical arc trajectory among all the candidate elliptical arc trajectories.
[0071] In the process of determining the initial iterative inflection point, the iteration priority of the first-level inflection point is higher than that of the second-level inflection point, that is, both the first-level inflection point and the second-level inflection point can be used as iteration points. After the iteration of the first-level inflection point is completed, the second-level inflection point is iterated. For the convenience of description, in this embodiment, the initial iterative inflection point is taken as the first-level inflection point for explanation.
[0072] The process of S201-S205 can be described as follows: Figure 6 As shown, the coordinates of the parking start point M are [0, -4], and the line segment OM can be equally divided into 4 sub-intervals, so there are three first-level parking inflection points, whose coordinates are [0, -3], [0, -2], and [0, -1]. Exemplarily, each sub-interval includes five parking inflection points, and the five parking inflection points are determined as second-level parking inflection points. A parking inflection point is determined as the initial iteration inflection point among the three first-level parking inflection points, and multiple parking elliptical arc trajectories are constructed based on the initial iteration inflection point. For example, four quarter elliptical arcs are constructed based on the initial iteration inflection point, as shown in FIG. Figure 8 As shown, the major and minor semi-axes of the four elliptical arcs are (5.08, 4.88) (5.32, 5.00) (5.53, 5.10) (6.09, 5.20) respectively. Each of the initial parked elliptical arc trajectories is tested and verified, and in response to determining that there is an initial parked elliptical arc trajectory that passes the test verification, the initial parked elliptical arc trajectory that passes the test verification is determined as a candidate elliptical arc trajectory.
[0073] It should be noted that parking trajectory planning can have "accuracy priority strategy" and "time priority strategy", among which the basic requirement of the accuracy priority strategy is "the parking trajectory should be short", and the basic requirement of the time priority strategy is "the trajectory planning time should be short".
[0074] For the "accuracy priority strategy", after executing S201-S205, it is necessary to continue to execute S206-S209, which is described as follows: Since the initial parking elliptical arc trajectory constructed by the initial iteration inflection point can pass the test verification, it means that the elliptical arc trajectory constructed by the secondary parking inflection point in the sub-interval adjacent to the initial iteration inflection point may be more in line with the requirements of the accuracy priority strategy, thereby saving the parking time of the vehicle. Based on the above planning requirements, a target sub-interval can be determined among multiple sub-intervals, and at least a secondary parking inflection point adjacent to the initial iteration inflection point is selected in the target sub-interval, and multiple parking elliptical arc trajectories are continued to be constructed based on the secondary parking inflection point. The multiple parking elliptical arc trajectories are called interval parking elliptical arc trajectories. Test verification is performed on each of the interval parking elliptical arc trajectories. In response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, the interval parking elliptical arc trajectory that passes the test verification is also determined as a candidate elliptical arc trajectory.
[0075] The above describes the process of determining the candidate elliptical arc trajectory from the initial parked elliptical arc trajectory, and the process of determining the candidate elliptical arc trajectory from the interval parked elliptical arc trajectory. For the "precision priority strategy", it is necessary to determine the target elliptical arc trajectory among all the candidate elliptical arc trajectories determined by the two processes, so as to determine a more precise and shorter parked elliptical arc trajectory as the target elliptical arc trajectory.
[0076] For the "time priority strategy", after executing S201-S205, it is only necessary to continue to execute S209 to plan the parking trajectory more quickly. In this case, as long as there is an initial parking elliptical arc trajectory that can pass the test verification, the target elliptical arc trajectory determination process can be entered. For example, if there are two initial parking elliptical arc trajectories that pass the test verification, one of them is determined as the target elliptical arc trajectory through the target elliptical arc trajectory determination process and output. Therefore, there is no need to determine the target sub-interval based on the initial parking elliptical arc trajectory, nor to construct the interval parking elliptical arc trajectory based on the secondary parking inflection point in the target sub-interval, and there is no process of testing and verifying the interval parking elliptical arc trajectory. Therefore, the parking trajectory planning time is saved, and the parking trajectory can be output as soon as possible.
[0077] The process of determining the target elliptical arc trajectory includes: calculating the first distance between the arc end point of each candidate elliptical arc trajectory and the parking start point; determining the minimum first distance among multiple first distances, and determining the second candidate elliptical arc trajectory corresponding to the minimum first distance as the target elliptical arc trajectory. The above process of determining the target elliptical arc trajectory is the process of determining the shortest parking trajectory among multiple parking trajectories, and the parking elliptical arc trajectory determined in this way can save more parking time.
[0078] In this embodiment, the "accuracy priority strategy" and "time priority strategy" of parking trajectory planning are described, wherein the "accuracy priority strategy" can determine a more precise and shorter target elliptical arc trajectory by executing S201-S209. When the user selects the "time priority strategy", the target elliptical arc trajectory can be determined more quickly by executing S201-S205 and S209. These two strategies can meet the different needs of users for parking trajectory planning and improve user experience.
[0079] The above embodiments illustrate the situation in which a candidate elliptical arc trajectory that passes the test verification can be screened out from an initial parking elliptical arc trajectory constructed by an initial iterative inflection point. The following embodiments further illustrate the process of determining a new initial iterative inflection point when a candidate head arc trajectory cannot be screened out from the initial parking elliptical arc trajectory constructed by the initial iterative inflection point.
[0080] In some embodiments, in response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, another new initial iteration inflection point is determined within the plurality of primary parking inflection points or secondary parking inflection points, and multiple new initial parking elliptical arc trajectories are determined based on the new initial iteration inflection point, until a new initial parking elliptical arc trajectory passes the test verification; or, until the upper limit of the number of iterations is reached;
[0081] In the process of determining another new initial iterative inflection point, the iteration priority of the first-level inflection point is higher than that of the second-level inflection point.
[0082] Based on the above, combined with Figure 3 , the automatic parking trajectory planning method of this embodiment can also be described as:
[0083] S301, determining an initial iteration inflection point from a plurality of first-level inflection points or second-level inflection points;
[0084] S302, determine whether the number of iterations reaches the upper limit of the number of iterations; if so, execute S307, if not, execute S303;
[0085] S303, constructing a plurality of initial elliptical arc trajectories based on the initial iteration turning point;
[0086] S304, determine whether there is an initial elliptical arc trajectory that can pass the test verification; if so, take the initial elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory and execute S305, if not, execute S306;
[0087] S305, determining a target elliptical arc trajectory from the candidate elliptical arc trajectories and outputting the target elliptical arc trajectory;
[0088] S306, determining another new initial iterative inflection point within the first-level parking inflection point or the second-level parking inflection point, and constructing multiple new initial parking elliptical arc trajectories (the number of iterations is increased by 1), and executing S304 until a new initial parking elliptical arc trajectory passes the test verification;
[0089] S307: If it is determined that the number of iterations reaches the upper limit of the number of iterations, the calculation fails.
[0090] The iteration priority of the first-level parking inflection point is higher than that of the second-level parking inflection point, that is, in S306, when all the first-level parking inflection points have been iterated, the second-level parking inflection point is selected as the iteration position. The iteration order of the first-level parking inflection point and the second-level parking inflection point can be randomly determined or executed based on a preset order, because the first-level parking inflection point and the second-level parking inflection point are both located on the y-axis, for example, the preset order is to proceed one by one from bottom to top, or the preset order is to proceed one by one from top to bottom.
[0091] Of course, if one wants to implement the "precision priority strategy" in the above embodiment, three steps, such as S206, S207, and S208, can also be inserted between S304 and S305 to determine a more precise and shorter target elliptical arc trajectory.
[0092] In addition, an upper limit of the number of iterations of the above iterative process may be set, for example, the upper limit of the number of iterations is 10 times.
[0093] In this embodiment, when the candidate elliptical arc trajectory cannot be screened out from the initial parking elliptical arc trajectory constructed by an initial iteration inflection point, the process of how to determine a new initial iteration inflection point is further defined. The process is essentially a process of how to perform orderly iteration of multiple first-level parking inflection points and multiple second-level parking inflection points. The basic principle of the iteration process is to iterate the second-level parking inflection points after the iteration of the first-level parking inflection points is completed. Because the first-level parking inflection points are nodes between sub-intervals and the number of nodes is small, when the candidate elliptical arc trajectory that passes the test verification can be screened out from the initial parking elliptical arc trajectory constructed by the first-level parking inflection points, it is easier to quickly determine the target sub-interval, select the second-level parking inflection point in the target sub-interval to construct the interval parking elliptical arc trajectory, and perform the subsequent target elliptical arc trajectory confirmation process. That is, the iteration priority of the first-level parking inflection point is higher than the basic principle of the second-level parking inflection point. For the case where the total number of parking inflection points is large, it is more conducive to the rapid screening of the target elliptical arc trajectory.
[0094] As a parallel embodiment, the following embodiment further explains how to determine a suitable parking inflection point within the parking inflection point interval and how to determine the target elliptical arc trajectory through testing and verification. Moreover, the following embodiment is more suitable for the case where the total number of parking inflection points is small.
[0095] In some embodiments, S102 constructs a plurality of parking elliptical arc trajectories based on at least one of the parking inflection points; in response to determining that there is a parking elliptical arc trajectory that passes the test verification, the parking elliptical arc trajectory that passes the test verification is determined as the target elliptical arc trajectory, and Figure 4 , further comprising:
[0096] S401, determining a parking inflection point in the parking inflection point interval, and using the parking inflection point as an initial iteration inflection point;
[0097] S402, constructing a plurality of initial elliptical arc trajectories based on the initial iterative turning point, and testing and verifying each of the initial elliptical arc trajectories;
[0098] S403, in response to determining that there is an initial parked elliptical arc trajectory that passes the test verification, determining the initial parked elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory;
[0099] S404, constructing a sub-interval within the parking-out inflection point interval based on the initial iteration inflection point;
[0100] S405, constructing a plurality of interval parking-out elliptical arc trajectories based on at least one parking-out inflection point in the sub-interval, and testing and verifying each of the interval parking-out elliptical arc trajectories;
[0101] S406: In response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, determine the interval parking elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory.
[0102] S407: Determine a target elliptical arc trajectory among all the candidate elliptical arc trajectories.
[0103] In this embodiment, since the total number of parking inflection points is small, the parking inflection points are no longer graded, that is, there are no first-level parking inflection points and second-level parking inflection points. Instead, a parking inflection point is randomly selected within the parking inflection point interval, and the parking inflection point is used as the initial iterative inflection point. When there is a candidate elliptical arc trajectory that can pass the test verification in the initial parking elliptical arc trajectory constructed based on the initial iterative inflection point, the "precision priority strategy" and "time priority strategy" of the aforementioned embodiment can also be selected.
[0104] For the "accuracy priority strategy", after executing S401-S403, it is necessary to continue to execute S404-S407, which is described as follows: Since the initial parking elliptical arc trajectory constructed by the initial iterative inflection point can pass the test verification, it means that the elliptical arc trajectory constructed by several parking inflection points adjacent to the initial iterative inflection point may be more in line with the accuracy priority strategy requirements to save the vehicle parking time. Based on the above planning requirements, a sub-interval containing the initial iterative inflection point can be constructed within the parking inflection point interval, and multiple parking elliptical arc trajectories can be further constructed based on the parking inflection points within the sub-interval. The multiple parking elliptical arc trajectories are called interval parking elliptical arc trajectories. Test and verify each of the interval parking elliptical arc trajectories, and in response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, the interval parking elliptical arc trajectory that passes the test verification is also determined as a candidate elliptical arc trajectory.
[0105] The above describes the process of determining the candidate elliptical arc trajectory from the initial parked elliptical arc trajectory, and the process of determining the candidate elliptical arc trajectory from the interval parked elliptical arc trajectory. For the "precision priority strategy", it is necessary to determine the target elliptical arc trajectory among all the candidate elliptical arc trajectories determined by the two processes, so as to determine a more precise and shorter parked elliptical arc trajectory as the target elliptical arc trajectory.
[0106] For the "time priority strategy", after executing S401-S403, it is only necessary to continue to execute S407 to plan the parking trajectory more quickly. In this case, as long as there is an initial parking elliptical arc trajectory that can pass the test verification, the target elliptical arc trajectory determination process can be entered. For example, if there are two initial parking elliptical arc trajectories that pass the test verification, one of them is determined as the target elliptical arc trajectory through the target elliptical arc trajectory determination process and output. Therefore, there is no need to determine the sub-interval based on the initial parking elliptical arc trajectory, nor to construct the interval parking elliptical arc trajectory based on the parking inflection point in the sub-interval, and there is no process of testing and verifying the interval parking elliptical arc trajectory. Therefore, the parking trajectory planning time is saved and the parking trajectory can be output as soon as possible.
[0107] The process of determining the target elliptical arc trajectory includes: calculating the first distance between the arc end point of each candidate elliptical arc trajectory and the parking start point; determining the minimum first distance among multiple first distances, and determining the second candidate elliptical arc trajectory corresponding to the minimum first distance as the target elliptical arc trajectory. The above process of determining the target elliptical arc trajectory is the process of determining the shortest parking trajectory among multiple parking trajectories, and the parking elliptical arc trajectory determined in this way can save more parking time.
[0108] In this embodiment, since the total number of parking inflection points is small, the parking inflection points are no longer graded, that is, there are no first-level parking inflection points and second-level parking inflection points. Instead, a parking inflection point is selected within the parking inflection point interval, so that the initial iteration inflection point can be determined more quickly, which is more conducive to the rapid screening of the target elliptical arc trajectory. In addition, this embodiment describes another "precision priority strategy" and "time priority strategy" for parking trajectory planning, wherein the "precision priority strategy" can determine a more precise and shorter target elliptical arc trajectory by executing S401-S407. When the user selects the "time priority strategy", the target elliptical arc trajectory can be determined more quickly by executing S401-S403 and S407. These two strategies can meet the different needs of users for parking trajectory planning and improve user experience.
[0109] The above embodiments illustrate the situation in which a candidate elliptical arc trajectory that passes the test verification can be screened out from an initial parking elliptical arc trajectory constructed by an initial iterative inflection point. The following embodiments further illustrate the process of determining a new initial iterative inflection point when a candidate head arc trajectory cannot be screened out from the initial parking elliptical arc trajectory constructed by the initial iterative inflection point.
[0110] In some embodiments, in response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, another new initial iterative inflection point is determined within the parking inflection point interval, and multiple new initial parking elliptical arc trajectories are determined based on the new initial iterative inflection point, until a new initial parking elliptical arc trajectory passes the test verification; or, until the upper limit of the number of iterations is reached.
[0111] Based on the above, combined with Figure 5 , the automatic parking trajectory planning method of this embodiment can also be described as:
[0112] S501, determining an initial iteration inflection point within the inflection point interval;
[0113] S502, determine whether the number of iterations reaches the upper limit of the number of iterations; if so, execute S507, if not, execute S503;
[0114] S503, constructing a plurality of initial elliptical arc trajectories based on the initial iteration turning point;
[0115] S504, determine whether there is an initial elliptical arc trajectory that can pass the test verification; if so, take the initial elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory and execute S505, if not, execute S506;
[0116] S505, determining a target elliptical arc trajectory from the candidate elliptical arc trajectories and outputting the target elliptical arc trajectory;
[0117] S506, determining another new initial iterative inflection point within the parking inflection point interval, and constructing multiple new initial parking elliptical arc trajectories (the number of iterations is increased by 1), and executing S504 until a new initial parking elliptical arc trajectory passes the test verification;
[0118] S507: If it is determined that the number of iterations reaches the upper limit of the number of iterations, the calculation fails.
[0119] Among them, the iteration order of the initial iterative inflection point can be determined randomly or executed based on a preset order, because the inflection points are all located on the y-axis. For example, the preset order is to alternately proceed from the inflection point located in the middle of the inflection point interval to both sides one by one.
[0120] Of course, if one wants to implement the "precision priority strategy" in the above embodiment, three steps, such as S404, S405, and S406, can be inserted between S504 and S505 to determine a more precise and shorter target elliptical arc trajectory.
[0121] In addition, an upper limit of the number of iterations of the above iterative process may be set, for example, the upper limit of the number of iterations is 10 times.
[0122] In this embodiment, the process of how to determine a new initial iterative turning point when no candidate elliptical arc trajectory can be screened out from the initial parking-out turning point constructed by an initial iterative turning point is further defined. This process is essentially a process of how to orderly iterate multiple parking-out turning points. This process does not need to determine the first-level parking-out turning point and the second-level parking-out turning point. Therefore, the initial iterative turning point can be determined more quickly. For the case where the total number of parking-out turning points is small, it is more conducive to the rapid screening of the target elliptical arc trajectory.
[0123] In addition, the test verification of the present application can be upgraded to the obstacle 5 distance verification based on the conventional collision verification to reduce the user's anxiety about the distance between the vehicle and the obstacle 5. Therefore, in the above-mentioned embodiment, in response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, further includes:
[0124] Determining a spacing line 52 of the obstacle 5 based on a boundary line 51 of the obstacle 5, and determining a boundary parking trajectory of the vehicle based on the target elliptical arc trajectory;
[0125] In response to determining that the vehicle boundary parking trajectory corresponding to each of the initial parking elliptical arc trajectories and the spacing line 52 of the obstacle 5 have overlapping portions, it is determined that there is no initial parking elliptical arc trajectory that passes the test verification;
[0126] The distance between the spacing line 52 of the obstacle 5 and the boundary line 51 of the obstacle 5 is a preset second distance, and the second distance varies according to the properties of the obstacle 5 .
[0127] The obstacle 5 may be a wall, another vehicle, a stone, etc., and may be determined by a vehicle camera or a parking space camera connected to the vehicle controller. The boundary line 51 of the obstacle 5 is obtained by enlarging the corresponding preset safety distance based on the size of the obstacle 5 itself. For example, referring to Fig.13 , the length and width of a certain obstacle 5 are both 1.2m, and the preset safety distance is 0.3m, then the length and width of the boundary line 51 of the obstacle 5 are both 1.5m. However, the safety distance of 0.3m is relatively small, which may easily cause the user to be anxious about the distance between the vehicle and the obstacle 5. That is, although the vehicle can normally bypass the obstacle 5, there is still a possibility of collision from the user's perspective. Therefore, the safety distance needs to be further increased, such as increasing the safety distance of 0.3m to 0.5m, that is, the preset second distance is 0.2m, then the length and width of the spacing line 52 of the obstacle 5 are both 1.5m. The spacing line 52 of the obstacle 5 constructed in this way is farther away from the obstacle 5 body than the boundary line 51 of the obstacle 5, which can effectively alleviate the user's anxiety about the distance between the vehicle and the obstacle 5.
[0128] In addition, the second distance is related to the properties of the obstacle 5. For example, the obstacle 5 is a trash can, and since the trash can is likely to have odor, the second distance can be set larger, for example, the second distance is 0.3m. Thus, the setting of different second distances makes the test verification more refined to improve the user experience.
[0129] The vehicle boundary parking trajectory is determined based on the parking arc trajectory. Specifically, the vehicle has left and right sides in the forward direction. For example, a vehicle with the driver's seat on the left and the passenger's seat on the right side includes the driver's side boundary parking trajectory b and the passenger's side boundary parking trajectory c. Fig.11 , Fig.12 As shown, the driver's side boundary parking track b, the passenger side boundary parking track c and the parking elliptical arc track a are parallel tracks, that is, for the corresponding track points on the three tracks, they are all concentric track points. For example, the radius of each track point in the parking elliptical arc track a is r, the radius of each track point in the driver's side boundary parking track b is r1', the radius of each track point in the passenger side boundary parking track c is r2', the vehicle width is D, and the vehicle driving safety distance is d, then r1'=r+(D / 2)+d, r2'=r-(D / 2)-d, and for example, d=0.5m. If the vehicle boundary parking track and the spacing line 52 of the obstacle 5 overlap, it means that the test verification has failed. If there is no overlap, it means that the test verification has passed.
[0130] In addition, the above test verification can also be used to determine the iteration order of the initial iteration inflection point. If the boundary parking trajectory b of the main driver's side coincides with the spacing line 52 of the obstacle 5, the initial iteration inflection point is moved down in the vehicle coordinate system so that the new boundary parking trajectory b of the main driver's side can be away from the spacing line 52 of the obstacle 5; if the boundary parking trajectory c of the passenger side coincides with the spacing line 52 of the obstacle 5, the initial iteration inflection point is moved up in the vehicle coordinate system so that the new boundary parking trajectory c of the passenger side can be away from the boundary line 51 of the obstacle 5. The upward or downward movement of the above iteration position is to make the vehicle away from the obstacle 5, avoid the risk of collision, and maintain a reasonable distance from the obstacle 5. This process also determines the new iteration position through geometric relationships, which is simple and fast, and is conducive to iterating out a suitable initial iteration inflection point as soon as possible and quickly generating the target elliptical arc trajectory.
[0131] It should be noted that the method of the embodiment of the present application can be performed by a single device, such as a computer or server. The method of this embodiment can also be applied to a distributed scenario and completed by multiple devices cooperating with each other. In the case of such a distributed scenario, one of the multiple devices can only perform one or more steps in the method of the embodiment of the present application, and the multiple devices will interact with each other to complete the described method.
[0132] It should be noted that the above describes some embodiments of the present application. Other embodiments are within the scope of the appended claims. In some cases, the actions or steps recorded in the claims can be performed in an order different from that in the above embodiments and still achieve the desired results. In addition, the processes depicted in the accompanying drawings do not necessarily require the specific order or continuous order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.
[0133] Based on the same inventive concept, corresponding to any of the above-mentioned embodiment methods, the present application also provides an automatic parking trajectory planning device.
[0134] refer to Fig.14 , the automatic parking trajectory planning device comprises:
[0135] A parking-out inflection point interval determining module 901 is configured to determine a parking-out inflection point interval based on the acquired parking-out starting point, wherein the parking-out inflection point interval includes a plurality of parking-out inflection points;
[0136] The target elliptical arc trajectory determination module 902 is configured to construct a plurality of parking-out elliptical arc trajectories based on at least one parking-out inflection point; in response to determining that there is a parking-out elliptical arc trajectory that passes the test verification, the parking-out elliptical arc trajectory that passes the test verification is determined as the target elliptical arc trajectory;
[0137] The output module 903 controls the vehicle to park based on the target elliptical arc trajectory.
[0138] Further, the target elliptical arc trajectory determination module 902 is configured to:
[0139] Dividing the inflection point interval into a plurality of sub-intervals;
[0140] The parking inflection points between adjacent sub-intervals are determined as the first-level parking inflection points, and the parking inflection points within the sub-intervals are determined as the second-level parking inflection points;
[0141] Determine an initial iteration inflection point among a plurality of first-order inflection points or second-order inflection points;
[0142] Constructing a plurality of initial parking elliptical arc trajectories based on the initial iteration inflection point, and testing and verifying each of the initial parking elliptical arc trajectories;
[0143] In response to determining that there is an initial parked elliptical arc trajectory that passes the test verification, determining the initial parked elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory;
[0144] A target elliptical arc trajectory is determined among all the candidate elliptical arc trajectories.
[0145] Furthermore, the target elliptical arc trajectory determination module 902 is further configured to:
[0146] Determining a target subinterval within a plurality of subintervals based on the initial iterative inflection point;
[0147] Constructing a plurality of interval parking-out elliptical arc trajectories based on at least one of the secondary parking-out inflection points in the target sub-interval, and testing and verifying each of the interval parking-out elliptical arc trajectories;
[0148] In response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, the interval parking elliptical arc trajectory that passes the test verification is determined as a candidate elliptical arc trajectory.
[0149] Furthermore, the target elliptical arc trajectory determination module 902 is further configured to:
[0150] In response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, another new initial iteration inflection point is determined within the plurality of first-level parking inflection points or second-level parking inflection points, and multiple new initial parking elliptical arc trajectories are determined based on the new initial iteration inflection point, until a new initial parking elliptical arc trajectory passes the test verification; or, until an upper limit of the number of iterations is reached;
[0151] Among them, the iteration priority of the first-level inflection point is higher than that of the second-level inflection point.
[0152] Furthermore, the target elliptical arc trajectory determination module 902 is further configured to:
[0153] Determine a parking inflection point within the parking inflection point interval, and use the parking inflection point as an initial iteration inflection point;
[0154] Constructing a plurality of initial parking elliptical arc trajectories based on the initial iteration inflection point, and testing and verifying each of the initial parking elliptical arc trajectories;
[0155] In response to determining that there is an initial parked elliptical arc trajectory that passes the test verification, determining the initial parked elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory;
[0156] A target elliptical arc trajectory is determined among all the candidate elliptical arc trajectories.
[0157] Furthermore, the target elliptical arc trajectory determination module 902 is further configured to:
[0158] Constructing a sub-interval within the parking-out inflection point interval based on the initial iteration inflection point;
[0159] Constructing a plurality of interval parking-out elliptical arc trajectories based on at least one parking-out inflection point in the sub-interval, and testing and verifying each of the interval parking-out elliptical arc trajectories;
[0160] In response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, the interval parking elliptical arc trajectory that passes the test verification is determined as a candidate elliptical arc trajectory.
[0161] Furthermore, the target elliptical arc trajectory determination module 902 is further configured to:
[0162] In response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, another new initial iterative inflection point is determined within the parking inflection point interval, and multiple new initial parking elliptical arc trajectories are determined based on the new initial iterative inflection point, until a new initial parking elliptical arc trajectory passes the test verification; or, until the upper limit of the number of iterations is reached.
[0163] Furthermore, the target elliptical arc trajectory determination module 902 is further configured to:
[0164] Calculating a first distance between an arc end point of each candidate elliptical arc trajectory and the parking start point;
[0165] A minimum first distance is determined among the multiple first distances, and a second candidate elliptical arc trajectory corresponding to the minimum first distance is determined as a target elliptical arc trajectory.
[0166] Furthermore, the target elliptical arc trajectory determination module 902 is further configured to:
[0167] Determining an obstacle spacing line based on the obstacle boundary line, and determining a vehicle boundary parking trajectory based on the target elliptical arc trajectory;
[0168] In response to determining that the vehicle boundary parking trajectory corresponding to each of the initial parking elliptical arc trajectories and the obstacle spacing line have overlapping portions, determining that there is no initial parking elliptical arc trajectory that passes the test verification;
[0169] The distance between the obstacle spacing line and the obstacle boundary line is a preset second distance, and the second distance varies according to the properties of the obstacle.
[0170] The system of the above embodiment is used to implement the corresponding automatic parking trajectory planning method in any of the above embodiments, and has the beneficial effects of the corresponding method embodiment, which will not be repeated here.
[0171] Based on the same inventive concept, corresponding to any of the above-mentioned embodiments and methods, the present application also provides an electronic device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein when the processor executes the program, the automatic parking trajectory planning method described in any of the above embodiments is implemented.
[0172] Fig.15 A more specific schematic diagram of the hardware structure of an electronic device provided in this embodiment is shown, and the device may include: a processor 1010, a memory 1020, an input / output interface 1030, a communication interface 1040, and a bus 1050. The processor 1010, the memory 1020, the input / output interface 1030, and the communication interface 1040 are connected to each other through the bus 1050 in the device.
[0173] The processor 1010 can be implemented by a general-purpose CPU (Central Processing Unit), a microprocessor, an application-specific integrated circuit (ASIC), or one or more integrated circuits, and is used to execute relevant programs to implement the technical solutions provided in the embodiments of this specification.
[0174] The memory 1020 may be implemented in the form of ROM (Read Only Memory), RAM (Random Access Memory), static storage device, dynamic storage device, etc. The memory 1020 may store an operating system and other application programs. When the technical solutions provided in the embodiments of this specification are implemented by software or firmware, the relevant program codes are stored in the memory 1020 and are called and executed by the processor 1010.
[0175] The input / output interface 1030 is used to connect the input / output module to realize information input and output. The input / output module can be configured in the device as a component (not shown in the figure), or it can be externally connected to the device to provide corresponding functions. The input device may include a keyboard, a mouse, a touch screen, a microphone, various sensors, etc., and the output device may include a display, a speaker, a vibrator, an indicator light, etc.
[0176] The communication interface 1040 is used to connect a communication module (not shown) to realize communication interaction between the device and other devices. The communication module can realize communication through a wired mode (such as USB, network cable, etc.) or a wireless mode (such as mobile network, WFI, Bluetooth, etc.).
[0177] The bus 1050 includes a path that transmits information between the various components of the device (eg, the processor 1010, the memory 1020, the input / output interface 1030, and the communication interface 1040).
[0178] It should be noted that, although the above device only shows the processor 1010, the memory 1020, the input / output interface 1030, the communication interface 1040 and the bus 1050, in the specific implementation process, the device may also include other components necessary for normal operation. In addition, it can be understood by those skilled in the art that the above device may also only include the components necessary for implementing the embodiments of the present specification, and does not necessarily include all the components shown in the figure.
[0179] The electronic device of the above embodiment is used to implement the corresponding automatic parking trajectory planning method in any of the above embodiments, and has the beneficial effects of the corresponding method embodiment, which will not be repeated here.
[0180] Based on the same inventive concept, corresponding to any of the above-mentioned embodiment methods, the present application also provides a non-transitory computer-readable storage medium, wherein the non-transitory computer-readable storage medium stores computer instructions, and the computer instructions are used to enable the computer to execute the automatic parking trajectory planning method described in any of the above embodiments.
[0181] The computer-readable medium of this embodiment includes permanent and non-permanent, removable and non-removable media, and information storage can be achieved by any method or technology. Information can be computer-readable instructions, data structures, modules of programs, or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static access memory (SRAM), dynamic access memory (DRAM), other types of access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, read-only compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, tape disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device.
[0182] The computer instructions stored in the storage medium of the above embodiment are used to enable the computer to execute the automatic parking trajectory planning method described in any of the above embodiments, and have the beneficial effects of the corresponding method embodiments, which will not be repeated here.
[0183] It is understandable that before using the technical solutions of each embodiment of the present disclosure, the type, scope of use, usage scenarios, etc. of the personal information involved will be informed to the user in an appropriate manner, and the user's authorization will be obtained.
[0184] For example, in response to receiving an active request from a user, a prompt message is sent to the user to clearly remind the user that the operation requested to be performed will require obtaining and using the user's personal information. Thus, the user can independently choose whether to provide personal information to software or hardware such as an electronic device, application, server, or storage medium that performs the operation of the technical solution of the present disclosure according to the prompt message.
[0185] As an optional but non-limiting implementation, in response to receiving the user's active request, the prompt information may be sent to the user in the form of a pop-up window, in which the prompt information may be presented in text form. In addition, the pop-up window may also carry a selection control for the user to choose "agree" or "disagree" to provide personal information to the electronic device.
[0186] It is understandable that the above notification and the process of obtaining user authorization are merely illustrative and do not constitute a limitation on the implementation of the present disclosure. Other methods that meet relevant laws and regulations may also be applied to the implementation of the present disclosure.
[0187] Those skilled in the art should understand that the discussion of any of the above embodiments is merely illustrative and is not intended to imply that the scope of the present application (including the claims) is limited to these examples. In line with the concept of the present application, the technical features in the above embodiments or different embodiments may be combined, the steps may be implemented in any order, and there are many other variations of the different aspects of the embodiments of the present application as described above, which are not provided in detail for the sake of simplicity.
[0188] In addition, to simplify the description and discussion, and in order not to make the embodiments of the present application difficult to understand, the known power supply / ground connection with the integrated circuit (IC) chip and other components may or may not be shown in the provided drawings. In addition, the device can be shown in the form of a block diagram to avoid making the embodiments of the present application difficult to understand, and this also takes into account the fact that the details of the implementation of these block diagram devices are highly dependent on the platform to be implemented in the embodiments of the present application (that is, these details should be fully within the scope of understanding of those skilled in the art). In the case of elaborating specific details (e.g., circuits) to describe exemplary embodiments of the present application, it is obvious to those skilled in the art that the embodiments of the present application can be implemented without these specific details or when these specific details are changed. Therefore, these descriptions should be considered to be illustrative rather than restrictive.
[0189] Although the present application has been described in conjunction with specific embodiments of the present application, many replacements, modifications and variations of these embodiments will be apparent to those skilled in the art from the foregoing description. For example, other memory architectures (e.g., dynamic RAM (DRAM)) may use the embodiments discussed.
[0190] The embodiments of the present application are intended to cover all such substitutions, modifications and variations that fall within the broad scope of the appended claims. Therefore, any omissions, modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the embodiments of the present application should be included in the scope of protection of the present application.
Claims
1. An automatic parking trajectory planning method, characterized in that: include: Determine a parking-out inflection point interval based on the acquired parking-out starting point, wherein the parking-out inflection point interval includes a plurality of parking-out inflection points; Constructing a plurality of parking-out elliptical arc trajectories based on at least one of the parking-out inflection points; in response to determining that there is a parking-out elliptical arc trajectory that passes the test verification, determining the parking-out elliptical arc trajectory that passes the test verification as a target elliptical arc trajectory; The vehicle is controlled to park based on the target elliptical arc trajectory.
2. The method according to claim 1, characterized in that The step of constructing a plurality of parking-out elliptical arc trajectories based on at least one parking-out inflection point; and in response to determining that there is a parking-out elliptical arc trajectory that passes the test verification, determining the parking-out elliptical arc trajectory that passes the test verification as a target elliptical arc trajectory, comprises: Dividing the inflection point interval into a plurality of sub-intervals; The parking inflection points between adjacent sub-intervals are determined as the first-level parking inflection points, and the parking inflection points within the sub-intervals are determined as the second-level parking inflection points; Determine an initial iteration inflection point among a plurality of first-order inflection points or second-order inflection points; Constructing a plurality of initial parking elliptical arc trajectories based on the initial iteration inflection point, and testing and verifying each of the initial parking elliptical arc trajectories; In response to determining that there is an initial parked elliptical arc trajectory that passes the test verification, determining the initial parked elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory; A target elliptical arc trajectory is determined among all the candidate elliptical arc trajectories.
3. The method according to claim 2, characterized in that Before determining the target elliptical arc trajectory among all the candidate elliptical arc trajectories, the method further includes: Determining a target subinterval within a plurality of subintervals based on the initial iterative inflection point; Constructing a plurality of interval parking-out elliptical arc trajectories based on at least one of the secondary parking-out inflection points in the target sub-interval, and testing and verifying each of the interval parking-out elliptical arc trajectories; In response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, the interval parking elliptical arc trajectory that passes the test verification is determined as a candidate elliptical arc trajectory.
4. The method according to claim 2, characterized in that: Also includes: In response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, another new initial iteration inflection point is determined within the plurality of first-level parking inflection points or second-level parking inflection points, and multiple new initial parking elliptical arc trajectories are determined based on the new initial iteration inflection point, until a new initial parking elliptical arc trajectory passes the test verification; or, until an upper limit of the number of iterations is reached; Among them, the iteration priority of the first-level inflection point is higher than that of the second-level inflection point.
5. The method according to claim 1, characterized in that: The step of constructing a plurality of parking-out elliptical arc trajectories based on at least one parking-out inflection point; and in response to determining that there is a parking-out elliptical arc trajectory that passes the test verification, determining the parking-out elliptical arc trajectory that passes the test verification as a target elliptical arc trajectory, comprises: Determine a parking inflection point within the parking inflection point interval, and use the parking inflection point as an initial iteration inflection point; Constructing a plurality of initial parking elliptical arc trajectories based on the initial iteration inflection point, and testing and verifying each of the initial parking elliptical arc trajectories; In response to determining that there is an initial parked elliptical arc trajectory that passes the test verification, determining the initial parked elliptical arc trajectory that passes the test verification as a candidate elliptical arc trajectory; A target elliptical arc trajectory is determined among all the candidate elliptical arc trajectories.
6. The method according to claim 5, characterized in that Before determining the target elliptical arc trajectory among all the candidate elliptical arc trajectories, the method further includes: Constructing a sub-interval within the parking-out inflection point interval based on the initial iteration inflection point; Constructing a plurality of interval parking-out elliptical arc trajectories based on at least one parking-out inflection point in the sub-interval, and testing and verifying each of the interval parking-out elliptical arc trajectories; In response to determining that there is an interval parking elliptical arc trajectory that passes the test verification, the interval parking elliptical arc trajectory that passes the test verification is determined as a candidate elliptical arc trajectory.
7. The method according to claim 5, characterized in that Also includes: In response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, another new initial iterative inflection point is determined within the parking inflection point interval, and multiple new initial parking elliptical arc trajectories are determined based on the new initial iterative inflection point, until a new initial parking elliptical arc trajectory passes the test verification; or, until the upper limit of the number of iterations is reached.
8. The method according to any one of claims 2, 3, 5 and 6, characterized in that: Determining a target elliptical arc trajectory from all the candidate elliptical arc trajectories comprises: Calculating a first distance between an arc end point of each candidate elliptical arc trajectory and the parking start point; A minimum first distance is determined among the multiple first distances, and a second candidate elliptical arc trajectory corresponding to the minimum first distance is determined as a target elliptical arc trajectory.
9. The method according to claim 4 or 7, characterized in that: In response to determining that there is no initial parking elliptical arc trajectory that passes the test verification, the method comprises: Determining an obstacle spacing line based on the obstacle boundary line, and determining a vehicle boundary parking trajectory based on the target elliptical arc trajectory; In response to determining that the vehicle boundary parking trajectory corresponding to each of the initial parking elliptical arc trajectories and the obstacle spacing line have overlapping portions, determining that there is no initial parking elliptical arc trajectory that passes the test verification; The distance between the obstacle spacing line and the obstacle boundary line is a preset second distance, and the second distance varies according to the properties of the obstacle.
10. An electronic device comprising a memory, a processor, and a computer program stored in the memory and running on the processor, characterized in that: When the processor executes the program, the method according to any one of claims 1 to 9 is implemented.
11. A vehicle, characterized in that: The vehicle includes the electronic device as claimed in claim 10.
