Diagonal Parking Space Detection Method, and Automatic Parking Method and System
20210354687 · 2021-11-18
Inventors
- Ming FAN (Guangzhou, Guangdong, CN)
- Qiaojun HE (Guangzhou, Guangdong, CN)
- Qinggui PAN (Guangzhou, Guangdong, CN)
- Hongshan ZHA (Guangzhou, Guangdong, CN)
Cpc classification
G06V10/44
PHYSICS
B62D15/0285
PERFORMING OPERATIONS; TRANSPORTING
G08G1/168
PHYSICS
G08G1/141
PHYSICS
G01S2015/936
PHYSICS
International classification
B60W30/06
PERFORMING OPERATIONS; TRANSPORTING
Abstract
Provided are a diagonal parking space detection method and device, and an automatic parking method and system. The diagonal parking space detection method includes: operation S11, determining a target diagonal parking space in multiple diagonal parking spaces arranged along a reference line, wherein the target diagonal parking space is located between a first reference parking space and a second reference parking space; operation S12, detecting a first reference point identifying an intersection point between the first reference parking space and the reference line; operation S13, calculating a slope of the target diagonal parking space; operation S14, detecting a second reference point identifying an intersection point between the second reference parking spacer and the reference line; and operation S15, calculating a width of the target diagonal parking space.
Claims
1. A diagonal parking space detection method, comprising: operation S11, determining a target diagonal parking space in a plurality of diagonal parking spaces arranged along a reference line, wherein the target, diagonal parking space is located between a first reference parking space and a second reference parking space; operation S12, detecting a first reference point identifying an intersection point between the first reference parking space and the reference line; operation S13, calculating a slope of the target diagonal parking space: operation S14, detecting a second reference point identifying an intersection point between the second reference parking space and the reference line; and operation S15, calculating a width of the target diagonal parking space according to the slope of the target diagonal parking space, a distance between the first reference point and the second reference point and a width of the first reference parking space.
2. The detection method as claimed in claim 1, wherein the first reference parking space, the target diagonal parking space and the second reference parking space are arranged along the'reference line in the same slope in an ascending order of their respective distance from a vehicle to be parked.
3. The detection method as claimed in claim 2, wherein the first reference point is, located on a first reference vehicle parked in the first reference parking space and the second reference point is located on a second, reference vehicle parked in the second reference parking space.
4. The detection method as claimed in claim 3, wherein the operation S12 comprises: controlling the vehicle to be parked to travel a set distance along the reference line toward the target diagonal parking space, and obtaining a plurality of sensor ranging values between the vehicle to be parked and a plurality of reflection points on the first reference vehicle; and judging whether a set of sensor ranging values within a set time period satisfies a set judgment condition, and in a case of judging that the set of sensor ranging values within the set time period satisfies the set judgment condition, taking a reflection point corresponding to a middle sensor ranging value in the set of sensor ranging, values as the first reference point.
5. The detection method as claimed in claim 4. wherein the operation S14 comprises: controlling the vehicle to be parked to travel a set distance along the reference line toward the target diagonal parking space, and obtaining a plurality of sensor ranging values between the vehicle to be parked and a plurality of reflection points on the second reference vehicle; and judging whether a set of sensor ranging values within a set time period satisfies a set judgment condition, and in a case of judging that the set of sensor ranging values within the set time period satisfies the set judgment condition, taking a reflection point corresponding to a middle sensor ranging value in the, set of sensor ranging values as the second reference point.
6. The detection method as claimed in claim 5, wherein judging whether the set of sensor ranging values within the set time period satisfies the set judgment condition comprises: judging whether the set of sensor ranging values simultaneously satisfies the following set judgment conditions: calculating an average value of the set of sensor ranging values, and judging whether the average value is within a first threshold range; calculating a difference between a maximum value and a minimum value in the set of sensor ranging values, and judging whether the difference is within a second threshold range; calculating a third value reflecting symmetry of the set of sensor ranging values according to a following formula and judging whether the third value is within a third threshold range:
7. The detection method as claimed in claim 6, wherein the first threshold range is set to 0.5-2 meters, the second threshold range is set to 0.2-0.6 meters, and the third threshold range and the fourth threshold range are calibrated according to actual situations.
8. The detection method as claimed in claim 3, wherein the operation S13 comprises controlling the Vehicle to be parked to travel a set distance along the reference line toward the target diagonal parking space, and acquiring a plurality of sensor ranging values between the vehicle to be parked and the second reference vehicle; and estimating the slope of the target diagonal parking space by a least squares method according to a travelling distance of the vehicle to be parked and the plurality of sensor ranging value.
9. The detection method as claimed in claim 8. wherein the slope of the target diagonal parking space is estimated according to a following formula:
10. The detection method as claimed in claim 1, wherein the operation S15 comprises: obtaining an included angle between the target diagonal parking space and the reference line according to the slope of the target diagonal parking space; and obtaining the width of the target diagonal parking space by subtracting the width of the first reference parking space from a product of the distance between the first reference point and the second reference point and a sine value of the included angle.
11. An automatic parking method, comprising: operation S21, determining a target diagonal parking space in a plurality of diagonal parking spaces arranged along a reference line, wherein the target diagonal parking space is located between a first reference parking space and a second reference parking space; operation S22, detecting a first reference point identifying an intersection point between the first reference parking space and the reference line; operation S23, calculating a slope of the target diagonal parking space; operation S24, detecting a second reference point identifying an intersection point between the second reference parking space and the reference line; operation S25, calculating a width of the target diagonal parking space according to the slope of the target diagonal parking space, a distance between the first reference point and the second reference point and a width of the first reference parking space; operation S26, outputting, the slope and width of the target diagonal parking space. and coordinates of the first reference point and the second reference point; and operation S27, planning an automatic parking route according to the slope and width of the target diagonal parking space, and the coordinates of the first reference point and the second reference point, and performing automatic parking according to the automatic parking route.
12. An automatic parking system, comprising: a diagonal parking space detection device comprising: a determination unit configured to determine a target diagonal parking space in a plurality of diagonal parking spaces arranged along a reference line, wherein the target diagonal parking space is located between a first reference parking space and a second reference parking space; a detection unit, configured to, detect a first reference point identifying an intersection point between the first reference parking space and the reference line and detect a second reference point identifying an intersection point between the second reference parking space and the reference line; a calculation unit, configured to calculate a slope of the target diagonal parking space and calculate a width of the target diagonal parking space according to the slope of the target diagonal parking space, a distance between the first reference point and the second reference point and a width of the first reference parking space; and an automatic parking control device, configured to plan, an automatic parking route according to the slope and width of the target diagonal parking space, and the coordinates of the first reference point and the second reference point, and perform automatic parking, according to the automatic parking route.
13. The automatic parking method as claimed in claim 11 wherein the first reference parking space, the target diagonal parking space and the second reference parking space are arranged along the reference line in the same slope in an ascending order of their respective distance from a vehicle to be parked.
14. The automatic parking method as, claimed in claim 11, wherein the operation S25 comprises: obtaining an included angle between the target diagonal parking space and the reference line according to the slope of the target diagonal parking space; and obtaining the width of the target diagonal parking space by subtracting the width of the first reference parking space from a product of the distance between the first. reference point and the second reference point and a sine value of the included angle.
15. The automatic parking method as claimed in claim 14, wherein the first reference point is located on a first reference vehicle parked in the first reference parking space, and the second reference point is located on a second reference vehicle parked in the second reference parking space.
16. The automatic parking method as claimed in claim 15, wherein the operation S22 comprises: controlling the vehicle to be parked to travel a set distance along the reference line toward the target diagonal parking space, and obtaining a plurality of sensor ranging values between the vehicle to be parked and a plurality of reflection points on the first reference vehicle; and judging whether a set of sensor ranging values within a set time period satisfies a set judgment condition, and in a case of judging that the set of sensor ranging values within the set time period satisfies the set judgment condition, taking a reflection point corresponding to a middle sensor ranging value in the set of sensor ranging values as the first reference point.
17. The automatic parking method as claimed in claim 16, wherein the operation S24 comprises: controlling the vehicle to be parked to travel a set distance along the reference line toward the target diagonal parking space, and obtaining a plurality of sensor ranging values between the vehicle to be parked and a plurality of reflection points on the second reference vehicle; and judging whether a set of sensor ranging values within a set time period satisfies a set judgment condition, and in a case of judging that the set of sensor ranging values within the set time period satisfies the set judgment condition, taking a reflection point corresponding to a middle sensor ranging value in the set of sensor ranging values as the second reference point.
18. The automatic parking method as claimed in claim 17, wherein judging whether the set of sensor ranging values within the set time period satisfies the set judgment condition comprises: judging whether the set of sensor ranging values simultaneously satisfies the following set judgment conditions: calculating an average value of the set of sensor ranging values, and judging whether the average value is within a first threshold range; calculating a difference between a maximum value and, a minimum value in the set of sensor ranging values, and judging whether the difference is within a second threshold range; calculating a third value reflecting symmetry of the set of sensor ranging values according to a following formula and, judging whether the third value is within a third threshold range:
19. The automatic parking system as claimed in claim 12, wherein the first reference parking space, the target diagonal parking space and the second reference parking space are arranged along the reference line in the same slope in an ascending order of their respective distance from a vehicle to be parked.
20. The automatic parking system as claimed in claim 12, wherein the calculation unit is configured to: obtain an included angle between the target diagonal parking space and the reference line according to the slope of the target diagonal parking space; and obtain the width of the target diagonal parking space by subtracting the width of the first reference parking space from a product of the distance between the first reference point and the second reference point and a sine value of the included angle.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0052] In order to more clearly illustrate the embodiments of the present disclosure or the technical solutions in the conventional art, the drawings used in the description of the embodiments or the conventional art will be briefly described below. It is apparent that the drawings in the following description are only some embodiments of the present disclosure, and other drawings can be obtained from those skilled in the art according to these drawings without any creative work.
[0053]
[0054]
[0055]
[0056]
DETAILED DESCRIPTION OF THE EMBODIMENTS
[0057] The following description of various embodiments is provided to illustrate implementable specific embodiments of the present disclosure with reference to the drawings.
[0058] Referring to
[0059] In operation S1, a target diagonal parking space is determined in multiple diagonal parking spaces arranged along a reference line, wherein the target diagonal parking space is located between a first reference parking space and a second reference parking space.
[0060] In operation S2, a first reference point identifying an intersection point between the first reference parking space and the reference line is detected.
[0061] In operation S3, a slope of the target diagonal parking space is calculated.
[0062] In operation S4, a second reference point identifying an intersection point between the second reference parking space and the reference line is detected.
[0063] In operation S5, a width of the target diagonal parking space is calculated according to the slope of the target diagonal parking space, a distance between the first reference point and the second reference point and a width of the first reference parking space.
[0064] Please refer to
[0065] In operation S1, a driver confirms that within 20 meters in front of a vehicle to be parked, there is an available parking space in multiple diagonal parking spaces arranged along a reference line L0 in the same slope, which is used as a target diagonal parking space. In the present embodiment, the reference line L0 is a horizontal line. Specifically, as shown in
[0066] It is to be noted that in the present embodiment, it is required to acquire ranging information of an ultrasonic sensor of the vehicle to be parked, that is, a body reflection echo of a preceding vehicle is collected, and the distance of sensor echoes is equal to a minimum distance from a transmitting point to a reflection point. Therefore, a first reference point a identifying an intersection point formed by the first reference parking space A1 and the reference line L0 and a second reference point b identifying an intersection, point formed by the second reference parking space A2 and the reference line L0 may be actually approximately replaced by points closest to the reference line L0 on reference vehicles respectively parked in the first reference parking space and the second reference parking space. For example, a point closest to the reference line L0 in the left front (also a reflection surface of the ultrasonic sensor) of the first reference vehicle parked in the first reference parking space A1 as shown in
[0067] The significance of detecting the first reference point a and the second reference point b in the present embodiment is that, on the one hand, the first reference point a is used as a starting point of the slope calculation of the target diagonal parking space, and on the other hand, after the slope is calculated, the width of the target diagonal parking space can be calculated in conjunction with the distance between the first reference point a and the second reference point b.
[0068] In operation S2, the first reference point a is detected by using a data feature extraction analysis method in the form of a window shift. Specifically, the vehicle to be parked is controlled to travel forward along the reference line L0 at a certain speed (i.e., from right to left as shown in
[0069] The vehicle to be parked is controlled to travel forward (i.e., from right to left shown in
[0070] First judgment condition: an average value of the set of sensor ranging values is calculated, and it is judged whether the average value is within a first threshold range, wherein in the present embodiment, the first threshold range is set to 0.5-2 meters.
[0071] Second judgment condition: a difference value between a maximum value and a minimum value in the set of sensor ranging values is calculated, and it is judged whether the difference value is within a second threshold range, wherein in the present embodiment, the second threshold range is set to 0.2-0.6 meters.
[0072] Third judgment condition: a third value reflecting symmetry of the set of sensor ranging values is calculated according to a following formula, and it is judged whether the third value is within a third threshold range, wherein the third threshold range is calibrated according to, an actual situation:
[0073] where, as mentioned above, the set of sensor ranging values is first-in first-out in the data buffer and will be arranged in chronological order, X.sub.m is the last sensor ranging value in the set of sensor ranging values, X.sub.m−1, is the penultimate sensor ranging value, i is a variable ranging from 0 to m/2, and X.sub.m−i−X.sub.i, represents a difference between sensor ranging values symmetrically located on both sides of a midpoint, the middle sensor ranging value in the set of sensor ranging values arranged above being taken as the midpoint. For example, the last sensor ranging value is subtracted from the first sensor ranging value, the penultimate sensor ranging value is subtracted from the second sensor ranging value, and so on.
[0074] Fourth judgment condition: a fourth value reflecting lower convexity of the set of sensor ranging values is calculated according to a following formula, and it is judged whether the fourth value is within a fourth threshold range, wherein the fourth threshold range is calibrated according to an actual situation:
[0075] where m is a subscript of the last sensor ranging value in the set of sensor ranging values, and i is a variable ranging from 0 to m/3.
[0076] If a set of sensor ranging values within a time period does not, satisfy any of the above conditions, it is necessary to continue to judge a set of sensor ranging values in another time period. When <a set of sensor ranging values within a set time period satisfies the above condition simultaneously, a reflection point corresponding to a middle sensor ranging value in the set of sensor ranging values is taken as the first reference point a,
[0077] After the first reference point a is detected in operation S2, operation S3 is performed to calculate the slope of the target diagonal parking space. It is to be understood that at this time, the ultrasonic sensor on the vehicle to be parked can receive the echo from the left body of the second reference vehicle parked in the second reference parking space, that is, there are multiple sensor ranging values between the vehicle to be parked and the second reference vehicle. As shown in
[0078] Specifically, after detecting the first reference point a, the sensor ranging values of the data buffer are cleared and a new sensor ranging value is started to be stored (i.e., multiple sensor ranging values between the vehicle to be parked and the second reference vehicle). Specifically, when the sensor ranging value between the vehicle to be parked and the second reference vehicle is in the range of 4.5 meters to 2 meters, data storage is started, and assuming that the stored sensor ranging values are x.sub.1, x.sub.2, . . . , x.sub.n, the slope K of the target diagonal parking space is calculated as follows:
[0079] x.sub.k represents the travelling distance of the vehicle to be parked, y.sub.k is a sensor ranging value between the vehicle to be parked and the second reference vehicle,
[0080] A manner of detecting the second reference point b identifying the intersection point between the second reference parking space and the reference line L0 in operation S4 is similar to the detection manner of operation S2, except that the sensor ranging values are different. The sensor ranging value in operation S4 is the sensor ranging value between the vehicle to be parked and the left front of the second reference vehicle. The judgment manner is still to judge whether a set of sensor ranging values in each time period satisfies the above four judgment conditions simultaneously, when set of sensor ranging values in a certain time period is satisfied simultaneously, a reflection point corresponding to the middle sensor ranging value in the set of sensor ranging values is taken as the second reference point b.
[0081] It is also to be noted that the foregoing detection of the first reference point a and the second reference point b is performed by the ultrasonic sensor r5 in the side front of the vehicle to be parked, and the first reference point a and the second reference point b are also detected by the side rear ultrasonic sensor r6 in the present embodiment, which is equivalent to further checking the points a and b, thereby reducing the position error.
[0082] Finally, the width of the target diagonal parking space is calculated in operation S5. As shown in
[0083] The detection method of the present embodiment can detect the diagonal parking spaces with different inclination angles, and is especially more accurate and effective for the inclination angle between 30-60 degrees, so that the ultrasonic sensor can be fixedly mounted without the need of rotatable mounting due to the transformation of the inclination angle of the diagonal parking space, thereby saving cost and man-hours.
[0084] According to the detection method of the first embodiment of the present disclosure, the width and inclination degree of the target diagonal parking space can be calculated, the coordinate position of the target diagonal parking space can also be obtained according to the first reference point a and the second reference point b in a given coordinate system, and this information is very important for the parking route planning of the diagonal parking space.
[0085] Therefore, as shown in
[0086] In operation S21, a target diagonal parking space is determined in multiple diagonal parking spaces arranged along a reference line, wherein the target diagonal parking space is located between a first, reference parking space and a second reference parking space.
[0087] In operation S22, a first reference point identifying an intersection point between the first reference parking space and the reference line is detected.
[0088] In operation S23, a slope of the target diagonal parking space is calculated.
[0089] In operation S24, a second reference point identifying an intersection point between the second reference parking space and the reference line is detected,
[0090] In operation S25, a width of the target diagonal parking space is calculated according to the slope of the target diagonal parking space, a distance between the first reference point and the second reference point and a width of the first reference parking space.
[0091] In operation S26, the slope and width of the target diagonal parking space, and coordinates of the first reference point and the second reference point are output.
[0092] In operation S27, an automatic parking route is planned according to the slope and width of the target diagonal parking space, and the coordinates of the first reference point and the second reference point, and automatic parking is performed according to the automatic parking route.
[0093] Correspondingly, a third embodiment of the present disclosure provides an automatic parking system, which includes: a diagonal parking space detection device and an automatic parking control device.
[0094] The diagonal parking space detection device further includes: a determination unit, a detection unit and a calculation unit.
[0095] The determination unit is configured to determine a target diagonal parking space in multiple diagonal parking spaces arranged along a reference line, wherein the target diagonal parking space is located between a first reference parking space and a second reference parking space.
[0096] The detection unit is configured to detect a first reference point identifying an intersection point between the first reference parking space and the reference line and detect a second reference point identifying an intersection point between the second reference parking space and the reference line.
[0097] The calculation unit is configured to calculate a slope of the target diagonal parking space and calculate a width of the target diagonal parking space according to the slope of the target diagonal parking space, a distance between the first reference point and the second reference point and a width of the first reference parking space.
[0098] The automatic parking control device is configured to plan an automatic parking route according to the slope and width of the target diagonal parking space, and the coordinates of the first reference point and the second reference point, and perform automatic parking according to the automatic parking route.
[0099] The working principle and the corresponding technical effects of the foregoing embodiments refer to the description of the first embodiment of the present disclosure, and details are not described herein again.
[0100] The above is a further detailed description of the present disclosure in connection with the specific preferred embodiments, and the specific embodiments of the present disclosure are not limited to the description. A number of simple derivations or replacements may be made by those of ordinary skill in the art without departing from the conception of the present disclosure, and all fall within the scope of protection of the present disclosure.