CN112208518B - Automatic parking path planning method - Google Patents
Automatic parking path planning method Download PDFInfo
- Publication number
- CN112208518B CN112208518B CN202011037676.XA CN202011037676A CN112208518B CN 112208518 B CN112208518 B CN 112208518B CN 202011037676 A CN202011037676 A CN 202011037676A CN 112208518 B CN112208518 B CN 112208518B
- Authority
- CN
- China
- Prior art keywords
- parking
- vehicle
- parking space
- preset
- current
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 230000007613 environmental effect Effects 0.000 claims description 8
- 238000005259 measurement Methods 0.000 claims description 3
- 238000007790 scraping Methods 0.000 abstract description 3
- 230000004888 barrier function Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000004904 shortening Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/06—Automatic manoeuvring for parking
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
The invention relates to the technical field of parking, and provides an automatic parking path planning method, which comprises the steps of collecting first environment information of a current parking space, using the current parking space as a planning base point of a parking path according to the first environment information, and establishing a parking coordinate system; whether the parking space meets the parking condition can be quickly determined according to the area division and the position datamation of the parking coordinate system; calculating the target parking position on the adjacent parking space according to a preset distance threshold value, and acquiring the optimal parking area of the vehicle, thereby fundamentally avoiding the risks of vehicle scraping and collision when the vehicle is parked in a garage; when the current parking space is unavailable, the parking path entering the adjacent parking space is re-planned according to the current position of the vehicle, so that the parking efficiency of the driver can be improved.
Description
Technical Field
The invention relates to the technical field of parking, in particular to an automatic parking path planning method.
Background
An automatic parking system means a system which can automatically park in a position without manual intervention. In the prior art, an automatic parking system transmits acquired image data and distance data of surrounding objects from a vehicle body to a central processing unit through a data line for analysis and processing, so as to obtain a current position, a target position and surrounding environment parameters of the vehicle, and makes an automatic parking strategy (planning a parking path and driving operation) according to the parameters, and converts the automatic parking strategy into an electric signal to be output to a vehicle strategy control system, and the vehicle strategy control system is controlled to perform related operations according to instructions, such as control on the driving angle, direction and power support of the vehicle.
The existing vehicle-mounted parking auxiliary system can only identify the obstacle information of the current parking space, for example, the information of the distance from the obstacle to the vehicle body is provided; however, when an obstacle appears on the parking path, the parking path cannot be automatically planned again, but the driver needs to drive the vehicle out of the current parking space, enter the lane and actively select the parking space, and then the parking path can be planned again, so that the time and the labor are consumed, and the parking efficiency is low.
Disclosure of Invention
The invention provides an automatic parking path planning method, which solves the technical problem that the prior art cannot automatically plan an optimal parking path when an obstacle is on a parking space, namely the prior art has low efficiency.
In order to solve the technical problems, the invention provides an automatic parking path planning method, which comprises the following steps:
s1, collecting first environment information of the current parking space, and establishing a parking coordinate system;
s2, judging whether the current parking space meets parking conditions or not according to the first environment information, and if not, acquiring second environment information of an adjacent parking space;
and S3, when the adjacent parking space meets the parking condition, calculating the target parking position on the adjacent parking space according to a preset distance threshold value, and replanning the parking path by combining the current position of the vehicle.
The basic scheme collects first environment information of a current parking space, and establishes a parking coordinate system by taking the current parking space as a planning base point of a parking path according to the first environment information; whether the parking space meets the parking condition can be quickly determined according to the area division and the position datamation of the parking coordinate system; calculating the target parking position on the adjacent parking space according to a preset distance threshold value, and acquiring the optimal parking area of the vehicle, thereby fundamentally avoiding the risks of vehicle scraping and collision when the vehicle is parked in a garage; when the current parking space is unavailable, the parking path entering the adjacent parking space is re-planned according to the current position of the vehicle, so that the parking efficiency of the driver can be improved.
In further embodiments, the step S1 includes the steps of:
s11, when a reversing signal of the vehicle is detected, collecting first environment information of the current parking space, and identifying a parking space line corresponding to the current parking space;
and S12, establishing a parking coordinate system by taking a vertex on the parking space line as an origin, establishing a horizontal axis in a direction parallel to the width of the current parking space and establishing a vertical axis in a direction parallel to the length of the current parking space.
According to the scheme, a reversing signal of the vehicle is collected to be used as a starting signal for planning a parking path, and environmental information is captured at the first time when the vehicle is reversed and stored; and establishing a parking coordinate system by combining the actual environment, and reflecting the current environment more truly.
In further embodiments, the step S2 includes the steps of:
s21, judging whether an obstacle exists in the current parking space according to the first environment information;
s22, when the obstacle is judged not to meet the available condition, determining that the current parking space does not meet the parking condition;
and S23, controlling the vehicle to reach the first preset position, and acquiring second environment information of the adjacent parking spaces.
The parking condition is that no obstacle exists in the parking space or the obstacle in the parking space meets the available condition;
the available condition is that the height of the obstacle is lower than a preset height threshold value or is out of a preset range; the preset range is a parking space middle area, wherein the distances between the preset range and the left side, the distance between the preset range and the right side and the distance between the preset range and the rear side of the parking space line are larger than or equal to the preset distance threshold.
The scheme judges whether the barrier exists or not and whether the height and the area information of the barrier meet the available conditions or not in sequence, can accurately determine the availability of the current parking space, effectively parks the vehicle when the barrier does not influence the parking of the vehicle, and further saves program operation resources.
In further embodiments, the step S3 includes the steps of:
s31, when the adjacent parking space meets the parking condition according to the second environment information, calculating a target parking position on the adjacent parking space according to a preset distance threshold;
and S32, planning to obtain a corresponding parking path by respectively taking the first preset position and the target parking position as a starting point and an end point.
According to the scheme, the target parking positions of the adjacent parking spaces are calculated according to the preset distance threshold, the optimal vehicle parking position can be directly determined, the first preset position and the target parking position are respectively used as the starting point and the terminal point, and the optimal parking path with the shortest distance and the shortest time can be obtained through planning.
In further embodiments, the step S32 includes the steps of:
s321, controlling the vehicle to advance to a second preset position, wherein a rear shaft of the vehicle at the second preset position is superposed with an X shaft;
s322, when the adjacent parking space is the left parking space, controlling the vehicle to rotate rightwards by a first preset angle by taking the right rear wheel as a fixed point; when the adjacent parking space is the right parking space, controlling the vehicle to rotate leftwards by a first preset angle by taking a left rear wheel as a fixed point;
s323, controlling the vehicle to linearly run to a third preset position, wherein fixed point wheels of the vehicle on the third preset position are intersected with a Y axis;
s324, controlling the vehicle to rotate at a second preset angle until the fixed-point wheel and the obstacle of the current parking space are located at the same horizontal position;
and S325, controlling the vehicle to back up linearly by taking the target parking position as a terminal point.
According to the scheme, the position where a rear shaft of a vehicle which moves forwards linearly and coincides with an X shaft is set as a second preset position, a second reference base point is established, different steering fixed points are divided by selecting a left rear wheel or a right rear wheel according to different adjacent parking places, a first preset angle is directionally rotated, after the vehicle linearly runs to a junction of the parking places, the vehicle is aligned back by taking a longitudinal coordinate of an obstacle as a reference, and finally the vehicle is parked to the target parking position by backing the vehicle linearly; the scheme has simple parking operation and short parking path distance, thereby shortening the parking time.
In a further embodiment, the step of calculating the second preset angle comprises:
a. acquiring a second coordinate of the fixed point wheel at the third preset position according to the first coordinate of the fixed point wheel at the second preset position and the first preset angle;
b. calculating a first positioning coordinate of a central point of a rear axle of the vehicle according to the second coordinate;
c. acquiring a second positioning coordinate of the center point of the rear axle according to the longitudinal coordinate of the obstacle and the preset distance threshold;
d. and respectively taking the first positioning coordinate and the second positioning coordinate as a starting point and an end point of the second preset angle, and calculating corresponding angle values by combining with a minimum turning radius.
In a further embodiment, in said step d, said angle value is calculated as follows:
wherein θ is the second preset angle, (x)H，yH)、(xK，yK) The first positioning coordinate and the second positioning coordinate are respectively the central point of the rear axle, RminIs the minimum turning radius of the vehicle.
According to the scheme, the first positioning coordinate and the second positioning coordinate are sequentially calculated according to the coordinate information of the vehicle at the second preset position by combining the first preset angle, the longitudinal coordinate of the obstacle and the preset distance threshold, and the minimum turning radius R of the vehicle in the lowest stable vehicle speed steering driving is consideredminThe aligning angle of the vehicle at the second predetermined position (i.e., the second predetermined angle) is calculated in a targeted manner.
In further embodiments, the target parking location is: and the distance between one side of the vehicle and the rear axle thereof and the vehicle line is the preset distance threshold.
In a further embodiment, the acquisition device for acquiring the first environmental information and the second environmental information comprises a distance measurement component and an image acquisition component; the ranging component comprises a millimeter wave radar; the image acquisition assembly comprises a camera.
According to the scheme, an image acquisition component is arranged to acquire an environment image on a parking space, and a parking coordinate system is generated after image processing; the distance measuring assembly is arranged on the rear side of the vehicle, so that the height of the obstacle in the parking space and the distance between the obstacle and the vehicle can be accurately detected, and the obstacle can be further accurately positioned by combining a parking coordinate system.
Drawings
Fig. 1 is a flowchart illustrating a parking route automatic planning method according to an embodiment of the present invention;
FIG. 2 is a schematic diagram of detection of a millimeter wave radar provided by an embodiment of the present invention;
FIG. 3 is a schematic vehicle dimension view provided by an embodiment of the present invention;
FIG. 4 is a schematic representation of a parking coordinate system provided by an embodiment of the present invention;
FIG. 5 is a schematic diagram of the turning path of the vehicle from step S321 to step S322 according to the embodiment of the present invention;
fig. 6 is a schematic diagram of the straight-line driving route of the vehicle in step S323 provided by the embodiment of the invention;
FIG. 7 is a schematic diagram of the route of the vehicle entering the adjacent parking space in step S324 according to the embodiment of the present invention;
fig. 8 is a schematic view of the final parking of the vehicle according to the embodiment of the present invention.
Detailed Description
The embodiments of the present invention will be described in detail below with reference to the accompanying drawings, which are given solely for the purpose of illustration and are not to be construed as limitations of the invention, including the drawings which are incorporated herein by reference and for illustration only and are not to be construed as limitations of the invention, since many variations thereof are possible without departing from the spirit and scope of the invention.
As shown in fig. 1, the parking path automatic planning method provided in the embodiment of the present invention includes steps S1 to S3:
s1, collecting first environment information of the current parking space, and establishing a parking coordinate system, wherein the method comprises the following steps of S11-S12:
s11, when a reversing signal of the vehicle is detected, collecting first environment information of the current parking space, and identifying a parking space line corresponding to the current parking space;
and S12, establishing a parking coordinate system by taking a vertex on the parking space line as an origin, establishing a transverse axis in a direction parallel to the width of the current parking space and establishing a longitudinal axis in a direction parallel to the length of the current parking space.
The environment information (the first environment information and the second environment information) at least comprises parking space line information and obstacle information of corresponding parking spaces.
Referring to fig. 3 and 4, in this embodiment, according to the adjacent parking space as the left parking space, the left vertex of the current parking space is preset as the origin O, the X axis is established in the extending direction of the front-end transverse parking space line, and the Y axis is established in the extending direction of the left longitudinal parking space line. Meanwhile, the length of the preset parking space is L, the width of the preset parking space is W, the axle distance between the front wheel and the rear wheel of the vehicle is L1, the wheel distance is W1, the front overhang length is L2, and the rear overhang length is L3; the preset distance threshold is d1, the distance between the vehicle and the longitudinal vehicle line is d2, and the transverse distance between the wheel and the edge of the vehicle body is d 3; s1、S2Respectively representing the obstacles on the current parking space and the left parking space.
The method comprises the steps of collecting a reversing signal of a vehicle as a starting signal for planning a parking path, and capturing environmental information at the first time when the vehicle is backed and stored; the method includes the steps that a parking space line of a current parking space is divided, a transverse axis is established in the direction parallel to the width of the current parking space, a longitudinal axis is established in the direction parallel to the length of the current parking space, a parking coordinate system is established by combining an actual environment, and the current environment is reflected more truly.
S2, judging whether the current parking space meets the parking condition according to the first environment information, if not, acquiring second environment information of an adjacent parking space, and the method comprises the following steps of S21-S23:
s21, judging whether an obstacle exists in the current parking space according to the first environment information;
s22, when judging that the obstacle does not meet the available condition, determining that the current parking space does not meet the parking condition;
and S23, controlling the vehicle to reach the first preset position, and acquiring second environment information of the adjacent parking spaces.
The parking condition is that no obstacle exists in the parking space or the obstacle on the parking space meets the available condition;
the available condition is that the height of the obstacle is lower than a preset height threshold value or outside a preset range; the preset range is a parking space middle area, wherein the distances between the parking space middle area and the left side, the right side and the rear side of the parking space line are all larger than or equal to a preset distance threshold d 1.
In this embodiment, whether the obstacle is within the preset range is determined by the following formula:
wherein (x)s，ys) As coordinates of the obstacle in the parking coordinate system XOY, d1To preset a distance threshold, d2The shortest distance from the vehicle to the longitudinal vehicle line (Y axis), W is the width of the current parking space, and L is the length of the current parking space.
When the coordinates of the obstacle satisfy the formula (1), the obstacle is within the preset range, and otherwise, the coordinates are opposite.
The embodiment sequentially judges whether the barrier exists or not and whether the height and the area information of the barrier meet the available conditions or not, can accurately determine the availability of the current parking space, effectively parks the vehicle when the barrier does not influence the parking of the vehicle, and further saves program running resources.
And S3, when the adjacent parking space meets the parking condition, calculating the target parking position of the adjacent parking space according to the preset distance threshold d1, and replanning the parking path by combining the current position of the vehicle.
In this embodiment, the target parking position is: the distance between one side of the vehicle and the rear axle of the vehicle and the parking space line is a preset distance threshold d 1.
In this embodiment, the step S3 specifically includes steps S31 to S32:
s31, when the adjacent parking spaces meet the parking conditions according to the second environment information, calculating target parking positions of the adjacent parking spaces according to a preset distance threshold d 1;
s32, planning and obtaining corresponding parking paths by taking the first preset position and the target parking position as a starting point and an end point respectively, and comprising the following steps of S321-S325:
s321, controlling the vehicle to advance to a second preset position, and enabling a rear shaft of the vehicle at the second preset position to coincide with the X shaft;
s322, when the adjacent parking space is the left parking space, controlling the vehicle to rotate rightwards by a first preset angle by taking the right rear wheel as a fixed point; when the adjacent parking space is the right parking space, controlling the vehicle to rotate leftwards by a first preset angle by taking the left rear wheel as a fixed point;
s323, controlling the vehicle to linearly run to a third preset position, wherein fixed-point wheels of the vehicle at the third preset position are intersected with the Y axis;
s324, controlling the vehicle to rotate at a second preset angle until the fixed-point wheels and the obstacle of the current parking space are located at the same horizontal position;
wherein the step of calculating the second preset angle comprises:
a. acquiring a second coordinate of the fixed point wheel at a third preset position according to the first coordinate of the fixed point wheel at the second preset position and the first preset angle;
b. calculating a first positioning coordinate of the central point of the rear axle of the vehicle according to the second coordinate;
c. acquiring a second positioning coordinate of the central point of the rear axle according to the longitudinal coordinate of the obstacle and a preset distance threshold d 1;
d. and respectively taking the first positioning coordinate and the second positioning coordinate as a starting point and an end point of a second preset angle, and calculating corresponding angle values by combining the minimum turning radius.
The angle value is calculated as follows:
wherein, theta is a second preset angle, (x)H，yH)、(xK，yK) Is a first positioning coordinate and a second positioning coordinate which are respectively the central point of the rear shaft, RminIs the minimum turning radius of the vehicle.
And S325, controlling the vehicle to linearly back by taking the target parking position as a terminal point.
In this embodiment:
and calculating the target parking position on the adjacent parking space according to the preset distance threshold d1, directly determining the optimal vehicle parking position, and planning to obtain the optimal parking path with the shortest distance and the shortest time by respectively taking the first preset position and the target parking position as a starting point and an end point.
Setting the position of a rear shaft of a vehicle which linearly advances to coincide with the X axis as a second preset position, establishing a second reference base point, selecting a left or right rear wheel to divide different steering fixed points according to different adjacent parking spaces, directionally rotating by a first preset angle, returning the vehicle to a right position by taking the ordinate of an obstacle as reference after the vehicle linearly travels to the junction of the parking spaces, and finally backing the vehicle linearly to park the vehicle at a target parking position; the scheme has simple parking operation and short parking path distance, thereby shortening the parking time.
According to the coordinate information of the vehicle at the second preset position, combining the first preset angle, the longitudinal coordinate of the obstacle and the preset distance threshold value d1, sequentially calculating to obtain a first positioning coordinate and a second positioning coordinate, and considering the minimum turning radius R of the vehicle in the lowest stable speed steering drivingminThe aligning angle of the vehicle at the second predetermined position (i.e., the second predetermined angle) is calculated in a targeted manner.
In this embodiment, referring to fig. 2, the collecting device for collecting the first environmental information and the second environmental information includes a distance measuring component and an image acquiring component; the distance measurement component comprises a millimeter wave radar; the image acquisition assembly comprises a camera. Preferably, 3 millimeter wave radars (O) and at least 2 cameras are adopted for data acquisition, and 3 millimeter wave radars (O)10、O20、O30) Uniformly installed at the tail of the vehicle, and 2 cameras are respectively installed at the positions of the left outer rearview mirror and the right outer rearview mirror.
In the embodiment, the image acquisition component is arranged to acquire an environment image on the parking space, and a parking coordinate system is generated after image processing; the distance measuring assembly is arranged on the rear side of the vehicle, so that the height of the obstacle in the parking space and the distance between the obstacle and the vehicle can be accurately detected, and the obstacle can be further accurately positioned by combining a parking coordinate system.
In the embodiment of the present invention, referring to fig. 4 to 8, (A, B, C, H, K represents coordinates of center points of rear axles of vehicles at different parking positions, respectively), taking as an example that a left parking space is available, and a current parking space, that is, a right parking space is unavailable, a specific parking path planning process is as follows:
when a reversing signal of the vehicle is detected, driving a camera to acquire images, establishing a parking coordinate system XOY after data processing, driving a millimeter wave radar to detect an obstacle, and detecting the obstacle when the obstacle S is detected1When the height of the parking space meets the preset height preset value and the coordinate of the parking space meets the formula (1), the current parking space is unavailable.
Thus, a parking path to the left adjacent parking space is planned:
firstly, controlling the vehicle to run in a reverse mode until the vehicle reaches an obstacle S1When the distance from the vehicle is equal to a preset safety distance threshold value d1 (namely, the vehicle reaches a first preset position), the camera and the millimeter wave radar are controlled to detect the adjacent parking space, and the obstacle S existing in the right adjacent parking space is obtained2Resulting in the parking space being unavailable and only the left adjacent parking space being available.
And secondly, controlling the vehicle to linearly travel forward for a distance P1 until the rear axle of the vehicle is coincident with the X axis of the coordinate system, namely, the rear axle reaches a second preset position. Specifically, whether the rear wheel of the vehicle presses the parking space line at the front end of the current parking space (i.e., the left and right rear wheels of the vehicle coincide with point E, F, respectively, as shown in fig. 5) can be identified through the image captured by the camera, so as to determine whether the rear axis of the vehicle coincides with the X axis.
And thirdly, after the vehicle is driven to rotate rightwards at a fixed point by a first preset angle delta along a right rear wheel F (a first coordinate), controlling the steering wheel to return to the right, and linearly reversing for a driving distance P2 (along a straight line l1 or a straight line l2) until the rear right wheel is intersected with the Y axis of the coordinate system, namely reaching a third preset position. Wherein:
the first preset angle delta is 60 degrees, and specific numerical values can be set by self according to different vehicle types.
The abscissa of the first coordinate F is such that,
the second coordinate G has an ordinate of yG-OF tan α, wherein
The fourth step is to add O1And controlling the vehicle to rotate by a second preset angle for the circle center until the rear wheel on the right side and the obstacle of the current parking space are positioned at the same horizontal position, and controlling the steering wheel to return to the right position.
The first fixed point coordinate H of the center point of the rear axle of the vehicle is,
the second fixed point coordinate K of the center point of the rear axle of the vehicle is,
yK＝yS；
and substituting the coordinates of the first fixed point coordinate H and the second fixed point coordinate K into a formula (2) to obtain a second preset angle.
And fifthly, the vehicle is driven to a target parking position in a straight line reversing mode, namely the center point of the rear axle of the vehicle is coincided with the point D, and the backing-up storage is finished.
From the above, the coordinates of the target parking position D are,
yD＝-L+L3+d1(ii) a And the distance for the straight backing of the vehicle is dKD＝|yD-yS|。
Similarly, when detecting that the right adjacent parking space is available, the principle of the method is similar to the parking path planning algorithm of the left adjacent parking space, and therefore the method is not repeated.
The method comprises the steps of collecting first environment information of a current parking space, using the current parking space as a planning base point of a parking path according to the first environment information, and establishing a parking coordinate system; whether the parking space meets the parking condition can be quickly determined according to the area division and the position datamation of the parking coordinate system; calculating a target parking position on an adjacent parking space according to a preset distance threshold d1, and acquiring an optimal parking area of a vehicle, thereby fundamentally avoiding the risks of vehicle scraping and collision when the vehicle is parked in a garage; when the current parking space is unavailable, the parking path entering the adjacent parking space is re-planned according to the current position of the vehicle, so that the parking efficiency of the driver can be improved.
The above embodiments are preferred embodiments of the present invention, but the present invention is not limited to the above embodiments, and any other changes, modifications, substitutions, combinations, and simplifications which do not depart from the spirit and principle of the present invention should be construed as equivalents thereof, and all such changes, modifications, substitutions, combinations, and simplifications are intended to be included in the scope of the present invention.
Claims (7)
1. A parking path automatic planning method is characterized by comprising the following steps:
s1, collecting first environment information of the current parking space, and establishing a parking coordinate system;
s2, judging whether the current parking space meets parking conditions or not according to the first environment information, and if not, acquiring second environment information of an adjacent parking space;
s3, when the adjacent parking spaces meet the parking condition, calculating target parking positions of the adjacent parking spaces according to a preset distance threshold value, and replanning parking paths by combining the current positions of vehicles;
the step S2 includes the steps of:
s21, judging whether an obstacle exists in the current parking space according to the first environment information;
s22, when the obstacle is judged not to meet the available condition, determining that the current parking space does not meet the parking condition;
s23, controlling the vehicle to reach a first preset position, and collecting second environment information of adjacent parking spaces;
the step S3 includes the steps of:
s31, when the adjacent parking space meets the parking condition according to the second environment information, calculating a target parking position on the adjacent parking space according to a preset distance threshold;
s32, planning to obtain corresponding parking paths by taking the first preset position and the target parking position as a starting point and an end point respectively;
the step S32 includes the steps of:
s321, controlling the vehicle to advance to a second preset position, wherein a rear shaft of the vehicle at the second preset position is superposed with an X shaft;
s322, when the adjacent parking space is the left parking space, controlling the vehicle to rotate rightwards by a first preset angle by taking the right rear wheel as a fixed point; when the adjacent parking space is the right parking space, controlling the vehicle to rotate leftwards by a first preset angle by taking a left rear wheel as a fixed point;
s323, controlling the vehicle to linearly run to a third preset position, wherein fixed point wheels of the vehicle on the third preset position are intersected with a Y axis;
s324, controlling the vehicle to rotate at a second preset angle until the fixed-point wheel and the obstacle of the current parking space are located at the same horizontal position;
and S325, controlling the vehicle to back up linearly by taking the target parking position as a terminal point.
2. A method for automatically planning a parking path according to claim 1, wherein said step S1 includes the steps of:
s11, when a reversing signal of the vehicle is detected, collecting first environment information of the current parking space, and identifying a parking space line corresponding to the current parking space;
and S12, establishing a parking coordinate system by taking a vertex on the parking space line as an origin, establishing a horizontal axis in a direction parallel to the width of the current parking space and establishing a vertical axis in a direction parallel to the length of the current parking space.
3. A method for automatically planning a parking path according to claim 1, wherein the step of calculating the second predetermined angle comprises:
a. acquiring a second coordinate of the fixed point wheel at the third preset position according to the first coordinate of the fixed point wheel at the second preset position and the first preset angle;
b. calculating a first positioning coordinate of a central point of a rear axle of the vehicle according to the second coordinate;
c. acquiring a second positioning coordinate of the center point of the rear axle according to the longitudinal coordinate of the obstacle and the preset distance threshold;
d. and respectively taking the first positioning coordinate and the second positioning coordinate as a starting point and an end point of the second preset angle, and calculating corresponding angle values by combining with a minimum turning radius.
4. A method for automatically planning a parking path according to claim 3 wherein in step d, the angle value is calculated as follows:
wherein θ is the second preset angle, (x)H，yH)、(xK，yK) The first positioning coordinate and the second positioning coordinate are respectively the central point of the rear axle, RminIs the minimum turning radius of the vehicle.
5. A method for automatic planning of a parking path according to claim 1, characterized in that:
the parking condition is that no obstacle exists in the parking space or the obstacle in the parking space meets the available condition;
the available condition is that the height of the obstacle is lower than a preset height threshold value or is out of a preset range; the preset range is a parking space middle area, wherein the distances between the preset range and the left side, the distance between the preset range and the right side and the distance between the preset range and the rear side of the parking space line are larger than or equal to the preset distance threshold.
6. A method for automatic planning of a parking path according to claim 1, wherein the target parking position is: and the distance between one side of the vehicle and the rear axle thereof and the vehicle line is the preset distance threshold.
7. A method for automatic planning of a parking path according to claim 1, characterized in that: the acquisition device for acquiring the first environmental information and the second environmental information comprises a distance measurement component and an image acquisition component; the ranging component comprises a millimeter wave radar; the image acquisition assembly comprises a camera.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011037676.XA CN112208518B (en) | 2020-09-28 | 2020-09-28 | Automatic parking path planning method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011037676.XA CN112208518B (en) | 2020-09-28 | 2020-09-28 | Automatic parking path planning method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112208518A CN112208518A (en) | 2021-01-12 |
| CN112208518B true CN112208518B (en) | 2022-02-01 |
Family
ID=74052084
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011037676.XA Active CN112208518B (en) | 2020-09-28 | 2020-09-28 | Automatic parking path planning method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112208518B (en) |
Families Citing this family (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112937555A (en) * | 2021-03-08 | 2021-06-11 | 华南理工大学 | Parallel parking trajectory planning method based on vehicle kinematics model |
| CN113129632A (en) * | 2021-03-30 | 2021-07-16 | 中国联合网络通信集团有限公司 | Autonomous parking method, AVP platform and parking lot management system |
| CN113353064B (en) * | 2021-04-30 | 2024-03-29 | 惠州华阳通用电子有限公司 | Automatic parking driving control method |
| CN113183952B (en) * | 2021-06-03 | 2022-05-27 | 上海电机学院 | Automatic parking method and system based on coordinate compensation |
| CN113353068A (en) * | 2021-07-26 | 2021-09-07 | 广州小鹏自动驾驶科技有限公司 | Parking control method, device, vehicle and medium |
| CN113753029B (en) * | 2021-08-27 | 2023-11-17 | 惠州华阳通用智慧车载系统开发有限公司 | Automatic parking method and system based on optical flow method |
| CN113771839B (en) * | 2021-09-14 | 2023-10-10 | 武汉光庭信息技术股份有限公司 | Automatic parking decision planning method and system |
| CN114030463B (en) * | 2021-11-23 | 2024-05-14 | 上海汽车集团股份有限公司 | Path planning method and device for automatic parking system |
| CN114103934B (en) * | 2021-12-23 | 2023-06-16 | 岚图汽车科技有限公司 | Automatic parking path planning method, device, equipment and readable storage medium |
| CN114274952B (en) * | 2021-12-24 | 2023-09-22 | 重庆长安汽车股份有限公司 | Autonomous parking method and system for vertical parking space, storage medium and electronic equipment |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106740818A (en) * | 2016-12-19 | 2017-05-31 | 合肥工业大学 | A kind of automatic parking route planning method and system based on EPS |
| CN107697064A (en) * | 2017-08-18 | 2018-02-16 | 智车优行科技（北京）有限公司 | Automobile side is parked control device, method and automobile and storage medium |
| CN110126820A (en) * | 2019-05-17 | 2019-08-16 | 浙江吉利控股集团有限公司 | Automated parking system, method of parking and vehicle |
Family Cites Families (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4427953B2 (en) * | 2003-01-29 | 2010-03-10 | 株式会社豊田自動織機 | Parking assistance device |
| DE102013002283A1 (en) * | 2013-02-08 | 2014-08-14 | Volkswagen Ag | Method and device for Vorwärteinparken a motor vehicle in a transverse parking space |
| KR102267562B1 (en) * | 2015-04-16 | 2021-06-22 | 한국전자통신연구원 | Device and method for recognition of obstacles and parking slots for unmanned autonomous parking |
| KR102326057B1 (en) * | 2015-08-03 | 2021-11-12 | 현대모비스 주식회사 | Parking assistance apparatus and control method for the same |
| WO2017068698A1 (en) * | 2015-10-22 | 2017-04-27 | 日産自動車株式会社 | Parking support method and parking support device |
| JP6724425B2 (en) * | 2016-03-04 | 2020-07-15 | アイシン精機株式会社 | Parking assistance device |
| CN105857306B (en) * | 2016-04-14 | 2018-07-10 | 中国科学院合肥物质科学研究院 | A kind of vehicle autonomous parking paths planning method for a variety of scenes of parking |
| DE102017000859A1 (en) * | 2017-01-31 | 2017-07-06 | Daimler Ag | Method for parking or parking a vehicle in a parking facility |
| DE102017208385A1 (en) * | 2017-05-18 | 2018-11-22 | Ford Global Technologies, Llc | A method for supporting a parking operation of a motor vehicle, electronic parking assistance system and motor vehicle |
| RU2735340C1 (en) * | 2017-06-23 | 2020-10-30 | Ниссан Мотор Ко., Лтд. | Parking control method and parking control device |
| JP6828826B2 (en) * | 2017-10-05 | 2021-02-10 | 日産自動車株式会社 | Parking control method and parking control device |
| JP6904224B2 (en) * | 2017-11-15 | 2021-07-14 | トヨタ自動車株式会社 | Driving support device |
| US20210086759A1 (en) * | 2017-12-20 | 2021-03-25 | Nissan Motor Co., Ltd. | Parking Control Method and Parking Control Apparatus |
| CN110723135A (en) * | 2019-07-15 | 2020-01-24 | 惠州市德赛西威智能交通技术研究院有限公司 | Parking adjusting method and device based on automatic parking assisting system and storage medium |
| CN111319614B (en) * | 2020-01-07 | 2021-02-05 | 惠州市德赛西威汽车电子股份有限公司 | Automatic parking path planning method and device and storage medium |
| CN111319615B (en) * | 2020-03-16 | 2021-02-26 | 湖北亿咖通科技有限公司 | Intelligent passenger-replacing parking method, computer-readable storage medium and electronic device |
| CN111547047B (en) * | 2020-04-30 | 2022-07-01 | 惠州华阳通用电子有限公司 | Automatic parking method and device for parallel parking spaces |
-
2020
- 2020-09-28 CN CN202011037676.XA patent/CN112208518B/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106740818A (en) * | 2016-12-19 | 2017-05-31 | 合肥工业大学 | A kind of automatic parking route planning method and system based on EPS |
| CN107697064A (en) * | 2017-08-18 | 2018-02-16 | 智车优行科技（北京）有限公司 | Automobile side is parked control device, method and automobile and storage medium |
| CN110126820A (en) * | 2019-05-17 | 2019-08-16 | 浙江吉利控股集团有限公司 | Automated parking system, method of parking and vehicle |
Non-Patent Citations (2)
| Title |
|---|
| 基于信息融合的自动泊车系统车位线车位识别和决策规划;姜武华等;《中国机械工程》;20200525(第10期);全文 * |
| 基于终点区域化的自动平行泊车路径规划;高家坤等;《交通科学与工程》;20170330(第01期);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112208518A (en) | 2021-01-12 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN112208518B (en) | Automatic parking path planning method | |
| CN109649384B (en) | Parking assisting method | |
| CN111746504B (en) | Memory parking method, system, device and computer readable storage medium | |
| CN103158701A (en) | System and method of deriving parking trajectory for vehicle | |
| US10885356B2 (en) | Parking assisting apparatus and control unit | |
| CN112009462B (en) | Forward automatic parking method and device | |
| CN112771591B (en) | Method for evaluating the influence of an object in the environment of a vehicle on the driving maneuver of the vehicle | |
| EP3650284B1 (en) | Parking assistance method and parking assistance device | |
| CN112224199A (en) | Remote control parking control method and device, vehicle and storage medium | |
| CN112622885B (en) | Method and system for constructing inclined parking spaces based on ultrasonic radar | |
| CN112224198A (en) | Parking space parking method and device, vehicle and storage medium | |
| CN114274952A (en) | Vertical parking space autonomous parking method and system, storage medium and electronic device | |
| CN114056324A (en) | Parking space identification method and system based on data fusion | |
| US10970870B2 (en) | Object detection apparatus | |
| JP7346129B2 (en) | Parking support device and method of controlling the parking support device | |
| CN211044536U (en) | Automatic line patrol parking system based on label positioning identification | |
| CN116331189A (en) | Selecting parking spaces using probabilistic methods | |
| CN112224197B (en) | Method and device for detecting parking space during reversing, vehicle and storage medium | |
| CN113074746A (en) | Unmanned vehicle navigation method and device and unmanned vehicle | |
| CN113561964A (en) | Parking control method and system | |
| CN113954822A (en) | Method for automatically parking vehicle in side direction | |
| JP6167981B2 (en) | Driving assistance device | |
| EP4194320A1 (en) | Electronic control unit for park out of a vehicle | |
| US11529949B2 (en) | Parking assistant and method for adaptive parking of a vehicle to optimize overall sensing coverage of a traffic environment | |
| JP7224394B2 (en) | Delivery route generator and automatic delivery system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |