WO2020007235A1 - Parking space detection method and apparatus, and medium and device - Google Patents

Parking space detection method and apparatus, and medium and device Download PDF

Info

Publication number
WO2020007235A1
WO2020007235A1 PCT/CN2019/093486 CN2019093486W WO2020007235A1 WO 2020007235 A1 WO2020007235 A1 WO 2020007235A1 CN 2019093486 W CN2019093486 W CN 2019093486W WO 2020007235 A1 WO2020007235 A1 WO 2020007235A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
line segments
obstacle
parking space
adjacent high
Prior art date
Application number
PCT/CN2019/093486
Other languages
French (fr)
Chinese (zh)
Inventor
陈盛军
蒋少峰
肖志光
Original Assignee
广州小鹏汽车科技有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 广州小鹏汽车科技有限公司 filed Critical 广州小鹏汽车科技有限公司
Publication of WO2020007235A1 publication Critical patent/WO2020007235A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/06Automatic manoeuvring for parking
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/14Traffic control systems for road vehicles indicating individual free spaces in parking areas
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/932Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations

Definitions

  • the invention relates to the technical field of automatic parking, in particular to a parking space detection method, device, medium and equipment.
  • the first step in fully automatic parking is to detect parking spaces.
  • the parking space detection is carried out by using the ultrasonic radar around the vehicle to search along the vehicle travel path, and the parkingable areas are found from the areas to be detected on both sides of the travel path.
  • the travel path needs to be kept parallel to the area to be detected, and the parking space cannot be detected during the turning and reversing process of the vehicle.
  • Embodiments of the present invention provide a method, a device, a medium, and a device for detecting a parking space, which are used to solve a problem that a vehicle travel path and direction are limited during the parking space detection process.
  • the method includes:
  • the coordinate values of points on each obstacle detected by the corresponding ultrasonic radar are determined respectively for the left and right sides of the vehicle; and the left and right sides of the vehicle are respectively determined according to the obstacles.
  • the height attribute of the fitted line segment is determined.
  • the high and low attributes describe whether the points on the obstacles that make up the line segment originate from high or low objects;
  • a model matching method is used to determine whether there is a parking space between two adjacent high attribute line segments.
  • a parking space detection device includes:
  • a coordinate determining module configured to determine the coordinate values of points on each obstacle detected by a corresponding ultrasonic radar for the left and right sides of the vehicle if it is determined that the vehicle has moved;
  • a grouping module is used to group the points on the obstacle according to the distance from the point on the obstacle to the corresponding ultrasonic radar respectively for the left and right sides of the vehicle;
  • the line segment fitting module is used for line segment fitting according to the coordinate values of points on each obstacle in a group;
  • An attribute assignment module is used to determine the height attribute of the fitted line segment according to the proportion of the points on the obstacle having the secondary echo in a group.
  • the height attribute describes the source of the points on the obstacle constituting the line segment. Whether it is high or low;
  • a recognition module is used to determine whether there is a parking space between two adjacent high attribute line segments for the corresponding line segments on the left and right sides of the vehicle through a model matching method.
  • the present invention also provides a non-volatile computer storage medium.
  • the computer storage medium stores an executable program, and the executable program is executed by a processor to implement the steps of the method described above.
  • the invention also provides a parking space detection device, which includes a memory, a processor, and a computer program stored on the memory.
  • a parking space detection device which includes a memory, a processor, and a computer program stored on the memory.
  • the processor executes the program, the steps of the method described above are implemented.
  • the points on the obstacles detected by the ultrasonic radars on the left and right sides of the vehicle can be clustered and segmented to obtain the sets of obstacle line segments corresponding to the left and right sides of the vehicle, respectively. , And assign line segment high and low attributes, and determine whether there is a parking space between two adjacent high attribute line segments through a model matching method.
  • there are no restrictions on the travel path and direction of the vehicle which improves the universality of parking space detection.
  • FIG. 1 is a schematic flowchart of a parking space detection method according to a first embodiment of the present invention
  • Embodiment 1 of the present invention is a schematic diagram of a coordinate system provided by Embodiment 1 of the present invention.
  • Embodiment 3 is a schematic diagram of a sudden change in obstacle point distance provided by Embodiment 1 of the present invention.
  • Embodiment 4 is a schematic diagram of a parallel parking space provided by Embodiment 1 of the present invention.
  • Embodiment 1 of the present invention is a schematic diagram of a vertical parking space provided by Embodiment 1 of the present invention.
  • FIG. 6 is a schematic diagram of an included angle and a lateral depth distance between two adjacent high-performance line segments provided in Embodiment 1 of the present invention.
  • FIG. 7 is a contour description and a target posture corresponding to a parallel parking space provided in Embodiment 1 of the present invention.
  • FIG. 8 is a contour description and a target posture of a vertical parking space provided by Embodiment 1 of the present invention.
  • FIG. 9 is a schematic flowchart of a parking space identification method according to a second embodiment of the present invention.
  • FIG. 10 is a schematic structural diagram of a parking space detection device according to a third embodiment of the present invention.
  • FIG. 11 is a schematic structural diagram of a parking space detection device according to a fourth embodiment of the present invention.
  • a space described by a line segment composed of points on obstacles on the left and right sides of the vehicle may be referred to as an accessible space.
  • the parking space detection scheme provided by the present invention can circulate and traverse in the accessible space, search all the parking spaces during the driving process of the vehicle, and simultaneously recognize the parking spaces on the left and right sides. Moreover, there is no excessive requirement on the driving path during the parking space detection process, and the parking space detection can also be performed during the turning and reversing of the vehicle.
  • the roadside can be identified by the ultrasonic radar installed at a specified position, and the obstacle between the current vehicle and the target parking space can be described more completely.
  • the first embodiment of the present invention provides a parking space detection method.
  • the steps of the method can be shown in FIG. 1 and includes:
  • Step 101 Determine whether the vehicle moves.
  • the parking space detection may be triggered. Therefore, in this step, it can be determined whether the vehicle has moved, and if it is determined that the vehicle has moved, step 102 can be continued.
  • the vehicle posture can be understood as including vehicle center point coordinates and vehicle yaw angle.
  • the global absolute plane coordinate system is oxy
  • the vehicle local coordinate system is o'x'y '.
  • the coordinates of the center point of the vehicle may be the coordinates of the center point of the rear wheel axis of the vehicle.
  • the vehicle pose includes the center point coordinates of the rear wheel axis of the vehicle (that is, the coordinate origin o ′ point coordinate in the local coordinate system of the vehicle) and the vehicle yaw angle ( ⁇ 0 ).
  • the pose can be expressed as (x 0 , y 0 , ⁇ 0 ) in the global absolute plane coordinate system.
  • the vehicle posture can be determined based on the wheel pulse, inertial measurement unit (IMU), directional turning angle and other signal inputs, using the vehicle's accumulated dead reckoning formula.
  • IMU inertial measurement unit
  • Step 102 Determine coordinate values of points on the obstacle.
  • the coordinate values of points on each obstacle detected by the corresponding ultrasonic radar may be determined respectively for the left and right sides of the vehicle.
  • the coordinate value of the point on each obstacle can be determined in any way.
  • the coordinate value of the point on each obstacle can be, but is not limited to, the position and posture of the vehicle.
  • the point on the obstacle reaches the corresponding ultrasonic wave.
  • the distance of the radar and the installation position of the ultrasonic radar on the vehicle are determined.
  • the ultrasonic radar in order to detect points on an obstacle, the ultrasonic radar needs to be installed at designated positions on the left and right sides of the vehicle.
  • the ultrasonic radar can be installed on the front wheel eyebrows of the vehicle, is perpendicular to the vehicle body axis, and the height above the ground is a specified height.
  • the specified height can be set according to the characteristics of different ultrasonic radars, relative to the center of the rear wheel shaft. dimensions' of L x, L y.
  • the installation position of the ultrasonic radar on the right side of the vehicle can be shown in Figure 2.
  • the point on the obstacle detected by the ultrasonic radar, and the distance to the ultrasonic radar can be expressed by d.
  • the symbols of Ly and d can be specified as the left side of the vehicle's forward direction is negative, the right side is positive, and the sign of L x can be specified as both positive.
  • the coordinate formula (x p , y p ) of the point P on the obstacle in the global absolute plane coordinate system oxy can be expressed as:
  • Step 103 Group the points on the obstacle.
  • step 102 and step 103 are performed in no particular order. In this embodiment, description is made by taking step 103 to be performed after step 102 as an example.
  • the ultrasonic radar detects the contour point of the obstacle, the contour of the obstacle does not change suddenly, so when the distance between the detected obstacle and the corresponding ultrasonic radar changes suddenly, it can be understood as the point The belonging obstacle has changed. Therefore, in this embodiment, the points belonging to different obstacles can be grouped according to whether the distance is abruptly changed, and the points on the obstacles can be clustered.
  • the points on the obstacle can be grouped for the left and right sides of the vehicle respectively according to the distance from the points on the obstacle to the corresponding ultrasonic radar.
  • the distance from the point on the currently detected obstacle to the corresponding ultrasonic radar for the left and right sides of the vehicle, respectively, and the obstacle detected adjacent to the point on the obstacle before When the absolute value of the difference between the point on the object and the ultrasonic radar is greater than the set value, the points on the obstacle that are not grouped before the currently detected obstacle are divided into a group.
  • a point distance abrupt change on an obstacle is detected.
  • Vehicles for parking space detection can pass through No. 1 vehicle, roadside and No. 2 vehicle, and can scan the obstacle contour points as shown in FIG. 3. It can be found that during the continuous travel of the vehicle, for the point concentration obtained by scanning the same obstacle, the distance between two adjacent points does not change much. For different obstacles, the distance between two adjacent points at the edge will change abruptly, such as P (m) and P (m + 1), P (n) and P (n + 1). Therefore, all the scanned points can be clustered. Taking FIG. 3 as an example, clustering can be performed into three groups.
  • the distance detected by the ultrasonic radar is the maximum range value. At this time, it can also be understood as the distance of the point on the detected obstacle. A point on an obstacle was mutated.
  • Step 104 Perform line segment fitting.
  • line segment fitting can be performed according to the coordinate values of points on each obstacle in a group.
  • line segment fitting is performed for each group, and three line segments l1, l2, and l3 describing the outline of the obstacle can be obtained, where l1, l2 are body contours, and l3 is road contour.
  • the obtained point-related information on each obstacle such as coordinate values and distances, can be deleted to save storage space.
  • Step 105 Assign a line segment attribute.
  • the points on each obstacle may also have secondary echoes.
  • the ultrasonic radar scans a higher obstacle (such as a vehicle)
  • the ratio of the secondary echo is higher
  • a lower obstacle such as a road edge
  • the ultrasonic radar involved in the embodiments of the present invention has a secondary echo detection capability. Therefore, in this step, the height attribute of the fitted line segment can be determined according to the ratio of points on the obstacle with the secondary echo in each group.
  • the height attribute is described by the obstacles constituting the line segment. The points come from high or low objects.
  • the proportion of points on an obstacle with a secondary echo greater than a specific value can be grouped, and the corresponding line segment is determined to be a high attribute.
  • the outgoing line segment is determined as a low attribute.
  • the specific value may be 60% through an experimental test. Of course, the specific value can be adjusted according to the actual detection capability of the ultrasonic radar.
  • the line segment can be further understood as including left and right attributes.
  • the left and right attributes are described as whether the points on the obstacles constituting the line segment originate from the left side or the right side of the vehicle.
  • a line segment with a right attribute can also be added to a right line segment set, and a line segment with a left attribute can be added to a left line segment set, so as to facilitate subsequent parking spaces according to the right line segment set and the left line segment set.
  • Step 106 parking space identification.
  • a model matching method can be used to determine whether there is a parking space between two adjacent high attribute line segments.
  • the parking space on one side of the vehicle may be a parallel parking space.
  • a low attribute line segment is also included between two adjacent high attribute line segments, determine a lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and Whether the difference between them is greater than the first threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high-performance line segments and the vehicle length of the vehicle is greater than the second threshold value;
  • the difference between the lateral depth distance and the vehicle width of the vehicle is greater than a first threshold value, and the difference between the longitudinal length distance and the vehicle length of the vehicle is greater than a second threshold value, Then determine that there is at least one parking space between two adjacent high attribute line segments; or
  • a low attribute line segment is not included between two adjacent high attribute line segments, determine whether a difference between a longitudinal length distance between the adjacent two high attribute line segments and a vehicle length of the vehicle is greater than a second door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
  • two adjacent high-attribute line segments also include a low-attribute line segment
  • the width requirement of the vehicle for parking space detection only needs to determine whether the length (L3) of the space corresponding to the two line segments meets the vehicle length requirement of the vehicle for parking space detection and whether it can be used as a parking space.
  • the first threshold value may be 0.3 meters
  • the second threshold value may be 0.8 meters.
  • the lengths of the two adjacent high-level line segments are greater than the first specified value, thereby increasing the probability that the obstacles corresponding to the two adjacent high-level line segments are vehicles, thereby increasing The detected area is the accuracy of the parking space.
  • the first specified value may be 0.8 times the length of the vehicle of the vehicle for which parking space is detected.
  • the parking space on the side of the vehicle may also be a vertical parking space.
  • a low attribute line segment is also included between two adjacent high attribute line segments, determine the lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and the length of the vehicle Whether the difference between them is greater than the third threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high attribute line segments and the width of the vehicle is greater than the fourth threshold value;
  • the difference between the lateral depth distance and the vehicle length of the vehicle is greater than the third threshold value, and the difference between the longitudinal length distance and the vehicle width of the vehicle is greater than a fourth threshold value Value, determine that there is at least one parking space between two adjacent high attribute line segments; or,
  • the low attribute line segment is not included between two adjacent high attribute line segments, determine whether the difference between the longitudinal length distance between the adjacent two high attribute line segments and the vehicle width of the vehicle is greater than the fourth door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
  • the third threshold value may be 0.3 meters
  • the fourth threshold value may be 0.6 meters.
  • the lengths of two adjacent line segments with high attributes are both larger than the second specified value.
  • the second specified value may be 0.8 times the vehicle width of the vehicle for which parking space is detected.
  • the included angle between two adjacent high-level line segments is less than the first threshold, and the The lateral depth distance between the line segments is less than a second threshold.
  • FIG. 6 is a schematic diagram of an included angle and a lateral depth distance between two adjacent high attribute line segments.
  • the included angle ⁇ 12 between two adjacent high attribute line segments can be understood as an included angle obtained by extending L1 and L2.
  • the angle bisector LA as the included angle passes through the midpoints of L1 and L2 as the vertical line of LA to obtain the distance d1 and d2.
  • the lateral distance and depth distance d 12 of L1 and L2 are defined as the difference between d1 and d2.
  • Absolute value: d 12
  • the first threshold may be 25 degrees, and the second threshold may be 1 meter.
  • thresholds can all be adjusted according to the geometric size parameters and the steering capability of the vehicle performing the parking space detection.
  • each parameter is specified when performing parking space identification, so that the identified parking space can at least meet the requirements for parking a vehicle for parking space detection.
  • the upper limit of each parameter can also be set, so that the specific number of vehicles that can be parked in the identified parking space can be further determined, which will not be further described in this embodiment.
  • Step 107 Determine parking space information.
  • a contour description corresponding to the parking space existing between two adjacent high attribute line segments may be further determined, and the contour description is used to describe the location of the parking space, and / or, the parking space is determined.
  • the corresponding target posture of the vehicle enables automatic parking in the parking space according to the determined contour description and / or target posture during subsequent automatic parking.
  • the determined contour description and / or the target pose may be output for easy viewing.
  • FIG. 7 it is a contour description and a target posture diagram corresponding to parallel parking spaces.
  • FIG. 8 it is a contour description and a target posture diagram corresponding to a vertical parking space.
  • the parking space outline description may be, but is not limited to, five line segments corresponding to the six points A, B, C, D, E, and F, that is, the five line segments AB, BC, CD, DE, and EF may be used to describe the parking space.
  • Outline to facilitate path planning.
  • the values of the coordinates of C and D can be arbitrarily determined as required.
  • the coordinates of point C are determined based on the length of the BC plus 0.3 meters
  • the coordinates of the point D are determined based on the length of the DE plus 0.3 meters.
  • the coordinates of the point C are determined according to the length of the BC plus 0.3 meters
  • the coordinates of the point D are determined according to the length of the DE plus 0.3 meters.
  • the target pose can be expressed in the coordinates of the target vehicle center (point P coordinates, such as the center point of the rear wheel axis of the vehicle) and the direction of the arrow passing through point P (corresponding to the target yaw angle).
  • point P coordinates such as the center point of the rear wheel axis of the vehicle
  • direction of the arrow passing through point P corresponding to the target yaw angle.
  • it can be expressed as (x p , y p , ⁇ p ).
  • the determination method of the target yaw angle ⁇ p may also be different.
  • the final parking strategy can be the direction of the arrow passing point P and any of AB, CD, and EF.
  • the line segment remains parallel. Taking the direction of the arrow passing point P and AB as an example, then ⁇ p can be expressed as:
  • ⁇ p a tan 2 (y B -y A , x B -x A )
  • Atan2 ( ⁇ y, ⁇ x) is a function for calculating the arc tangent in the C language function. Compared with arctan ( ⁇ y / ⁇ x), a more stable calculation result is obtained.
  • the coordinates of the point P can be determined by, but not limited to, the four vertex coordinates of B, C, D, and E.
  • step 106 in the solution provided by the first embodiment of the present invention.
  • the second embodiment of the present invention provides a parking space identification method.
  • the step flow of the method can be shown in FIG. 9 and includes:
  • Step 201 Start searching from the first line segment of the line segment set.
  • the line segment with the left attribute and the line segment with the right attribute are in the same line segment set, and the left and right attributes of the line segment can be used to determine whether the line segment is from the left side or the right side of the vehicle.
  • i 1, and i represents the number of the line segment in the line segment set.
  • Step 202 Determine whether the line segment has a high attribute.
  • step 203 If yes, continue to step 203; otherwise, increase the line segment number by 1 and continue with this step.
  • Step 203 Initialize the high attribute line segment as the first obstacle vehicle L1.
  • step 204 it can be assumed that the obstacle corresponding to the high-attribute line segment is a vehicle, the obstacle vehicle is recorded as L1, and the line segment number is increased by 1, and the process proceeds to step 204.
  • Step 204 Determine whether the line segment is a high attribute.
  • step 205 it can be determined whether the line segment is of a high attribute. If so, step 205 is continued, otherwise, step 205 'is performed.
  • Step 205 Initialize the high attribute line segment as the second obstacle vehicle L2.
  • step 206 it can be assumed that the obstacle corresponding to the high attribute line segment is a vehicle, and the obstacle vehicle is recorded as L2, and step 206 can be continued to determine whether there is a parking space between L1 and L2.
  • Step 205 ' it is determined whether the line segment corresponding to L1 is located on the same side of the vehicle.
  • step 206 If yes, continue to step 206 '; otherwise, increase the line segment number by 1 and return to step 202.
  • Step 206 ' It is determined whether the lateral depth distance dp between the line segment and L1 is greater than the vehicle width.
  • this step it is determined whether the distance between the line segment and L1 is sufficient to accommodate a vehicle for parking space detection. Since the vehicle width value is smaller than the vehicle length value, in this step, the lateral depth distance dp can be compared with the vehicle width to determine whether the lateral depth distance dp is sufficient to accommodate the vehicle width.
  • Step 207 ' Add the line segment to the roadside line segment set.
  • step 204 it can be assumed that the obstacle corresponding to the low-attribute line segment is a roadside, and the roadside line segment set is added, and the line segment number can be increased by 1, and the process returns to step 204 to continue searching for the high-attribute line segment.
  • Step 206 Determine whether ⁇ 12 is less than 25 degrees, whether d 12 is less than 1 meter, and whether L3 is greater than the vehicle width + 0.6 meters.
  • step 207 it can be determined whether the included angle ⁇ 12 between the two adjacent high-performance line segments (that is, between L1 and L2), the lateral depth distance d 12 , and the longitudinal length distance L3 meet the requirements. If the requirements are met, the judgment can be continued, and step 207 is performed; otherwise, it can be considered that there is no parking space between L1 and L2, and step 208 'is performed.
  • this step it is determined whether the distance between L1 and L2 is sufficient to accommodate a vehicle for parking space detection. Because the vertical parking space has a smaller requirement for the longitudinal length distance L3 between L1 and L2, in this step, it can be determined first whether L3 meets the vertical parking space requirement.
  • Step 208 ' Initialize L2 as the first obstacle vehicle L1.
  • Step 207 Determine whether L3 is greater than the vehicle length +0.8 meters.
  • L3 meets the requirements for vertical parking spaces, further determine whether L3 meets the requirements for parallel parking spaces. If yes, proceed to step 208 to further determine the parallel parking space; otherwise, proceed to step 209 to further perform the vertical parking space judgment.
  • step 208 whether the lengths of L1 and L2 are greater than 0.8 times the vehicle length.
  • step 208 ' it can be determined that there is at least one parallel parking space between L1 and L2, and it can return to step 208 'to continue to find a parking space; otherwise, it can directly return to step 208'.
  • Step 209 Determine whether there are other line segments between L1 and L2.
  • step 210 If yes, go to step 210; otherwise, go to step 211.
  • Step 210 Determine whether the lateral depth distance dp of other line segments existing between L1 and L2 and at least one of L1 and L2 is greater than the vehicle length.
  • step 211 If L3 does not meet the requirements for parallel parking spaces, it is necessary to determine whether the distance between other line segments between L1 and L2 and L1 and L2 meets the requirements for vertical parking spaces. If yes, go to step 211; otherwise, go back to step 208 '.
  • Step 211 may be performed; otherwise, step 208 ′ may be performed.
  • Steps 211, L1, and L2 are all longer than 0.8 times the vehicle width.
  • Embodiment 3 of the present invention provides a parking space detection device.
  • the structure of the device may be as shown in FIG. 10 and includes:
  • the coordinate determination module 11 is configured to determine the coordinate values of points on each obstacle detected by the corresponding ultrasonic radar for the left and right sides of the vehicle if it is determined that the vehicle has moved;
  • the grouping module 12 is used to group the points on the obstacle according to the distance from the points on the obstacle to the corresponding ultrasonic radar respectively for the left and right sides of the vehicle;
  • the line segment fitting module 13 is configured to perform line segment fitting according to the coordinate values of points on each obstacle in a group;
  • the attribute assignment module 14 is used to determine the height attribute of the fitted line segment according to the proportion of the points on the obstacle having the secondary echo in a group.
  • the height attribute describes the source of the points on the obstacle constituting the line segment Whether it is high or low;
  • the identification module 15 is configured to determine whether there is a parking space between two adjacent high-attribute line segments for the corresponding line segments on the left and right sides of the vehicle through a model matching method.
  • the device further includes a parking space output module 16 for determining a contour description corresponding to a parking space existing between two adjacent high-attribute line segments, and the contour description is used to describe the location of the parking space, and / or The target posture of the vehicle corresponding to the parking space.
  • the coordinate determining module 11 is configured to determine a point on each obstacle by using a position of the vehicle, a distance from a point on the obstacle to a corresponding ultrasonic radar, and a mounting position of the ultrasonic radar on the vehicle. Coordinate value.
  • the grouping module 12 is specifically for the left and right sides of the vehicle, respectively, the distance from the point on the currently detected obstacle to the corresponding ultrasonic radar, and the obstacle detected adjacent to the point on the obstacle before When the absolute value of the difference between the distance from the upper point and the ultrasonic radar is greater than the set value, the points on the obstacle that are not grouped before the currently detected obstacle are divided into a group.
  • the identification module 15 is configured to determine whether there is a parking space between two adjacent high attribute line segments through a model matching method, including:
  • a low attribute line segment is also included between two adjacent high attribute line segments, determine a lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and Whether the difference between them is greater than the first threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high-performance line segments and the vehicle length of the vehicle is greater than the second threshold value;
  • the difference between the lateral depth distance and the vehicle width of the vehicle is greater than a first threshold value, and the difference between the longitudinal length distance and the vehicle length of the vehicle is greater than a second threshold value, Then determine that there is at least one parking space between two adjacent high attribute line segments; or
  • a low attribute line segment is not included between two adjacent high attribute line segments, determine whether a difference between a longitudinal length distance between the adjacent two high attribute line segments and a vehicle length of the vehicle is greater than a second door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
  • the identification module 15 is further configured to determine that the lengths of two adjacent high-segment line segments are greater than a first specified value.
  • the identification module 15 is configured to determine whether there is a parking space between two adjacent high-attribute line segments by using a model matching method, including: if a low-attribute line segment is also included between two adjacent high-attribution line segments, determining the low attribute Whether the difference between the lateral depth distance between the line segment and at least one of the two adjacent high attribute line segments and the vehicle length of the vehicle is greater than a third threshold; and Whether the difference between the longitudinal length distance between the line segments and the width of the vehicle is greater than a fourth threshold value;
  • the difference between the lateral depth distance and the vehicle length of the vehicle is greater than the third threshold value, and the difference between the longitudinal length distance and the vehicle width of the vehicle is greater than a fourth threshold value Value, determine that there is at least one parking space between two adjacent high attribute line segments; or,
  • the low attribute line segment is not included between two adjacent high attribute line segments, determine whether the difference between the longitudinal length distance between the adjacent two high attribute line segments and the vehicle width of the vehicle is greater than the fourth door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
  • the identification module 15 is further configured to determine that the lengths of two adjacent high attribute line segments are greater than a second specified value.
  • the identification module 15 is further configured to determine that an included angle between two adjacent high-level line segments is smaller than a first threshold, and a lateral depth distance between two adjacent high-level line segments is smaller than a second threshold.
  • embodiments of the present invention provide the following devices and media.
  • Embodiment 4 of the present invention provides a parking space detection device.
  • the structure of the device may include a memory 21, a processor 22, and a computer program stored on the memory, as shown in FIG. 11, and is implemented when the processor 22 executes the program. Steps of the method according to the first embodiment of the present invention.
  • the processor 22 may specifically include a central processing unit (CPU), an application-specific integrated circuit (ASIC), may be one or more integrated circuits for controlling program execution, and may be used
  • a hardware circuit developed by a field programmable gate array (FPGA, field programmable gate array) can be a baseband processor.
  • the processor 22 may include at least one processing core.
  • the memory 21 may include a read-only memory (ROM, read only memory), a random access memory (RAM, random access memory), and a magnetic disk memory.
  • ROM read-only memory
  • RAM random access memory
  • the memory 21 is configured to store data required when the at least one processor 22 is running.
  • the number of the memories 21 may be one or more.
  • Embodiment 5 of the present invention provides a non-volatile computer storage medium.
  • the computer storage medium stores an executable program.
  • the executable program is executed by a processor, the method provided in Embodiment 1 of the present invention is implemented.
  • a computer storage medium may include: a universal serial bus flash disk (USB, Universal Serial Bus flash drive), a mobile hard disk, a read-only memory (ROM, Read-Only Memory), and a random access memory (RAM , Random Access Memory), magnetic disk or compact disc and other storage media that can store program code.
  • USB Universal Serial Bus flash drive
  • ROM Read-Only Memory
  • RAM Random Access Memory
  • the disclosed device and method may be implemented in other manners.
  • the device embodiments described above are only schematic.
  • the division of the unit or unit is only a logical function division.
  • multiple units or components may The combination can either be integrated into another system, or some features can be ignored or not implemented.
  • the displayed or discussed mutual coupling or direct coupling or communication connection may be through some interfaces, the indirect coupling or communication connection of the device or unit, and may be electrical or other forms.
  • Each functional unit in the embodiment of the present invention may be integrated into one processing unit, or each unit may also be an independent physical module.
  • the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it may be stored in a computer-readable storage medium. Based on such an understanding, all or part of the technical solutions of the embodiments of the present invention may be embodied in the form of a software product.
  • the computer software product is stored in a storage medium and includes several instructions for making a computer device, for example, may be A personal computer, a server, or a network device, or a processor executes all or part of the steps of the method described in each embodiment of the present invention.
  • the foregoing storage medium includes: a universal serial bus flash drive (universal serial flash drive), a mobile hard disk, a ROM, a RAM, a magnetic disk, or an optical disc, and other media that can store program codes.
  • the embodiments of the present invention may be provided as a method, a system, or a computer program product. Therefore, the present invention may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Moreover, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
  • computer-usable storage media including, but not limited to, disk storage, CD-ROM, optical storage, etc.
  • These computer program instructions may be provided to a processor of a general-purpose computer, special-purpose computer, embedded processor, or other programmable data processing device to produce a machine, so that the instructions generated by the processor of the computer or other programmable data processing device are used to generate instructions Means for implementing the functions specified in one or more flowcharts and / or one or more blocks of the block diagrams.
  • These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to work in a specific manner such that the instructions stored in the computer-readable memory produce a manufactured article including an instruction device, the instructions
  • the device implements the functions specified in one or more flowcharts and / or one or more blocks of the block diagram.
  • These computer program instructions can also be loaded onto a computer or other programmable data processing device, so that a series of steps can be performed on the computer or other programmable device to produce a computer-implemented process, which can be executed on the computer or other programmable device.
  • the instructions provide steps for implementing the functions specified in one or more flowcharts and / or one or more blocks of the block diagrams.

Abstract

Disclosed are a parking space detection method and apparatus, and a medium and a device. The method comprises: respectively performing clustering and piecewise fitting on points on an obstacle detected by ultrasonic radars at left and right sides of a vehicle, so as to obtain a set of obstacle line segments (l1, l2, l3) respectively corresponding to the left and right sides of the vehicle, and endowing the line segments with high and low attributes; and by means of a model matching method, determining whether there is a parking space between two adjacent line segments (l1, l2) with the high attribute. Both a driving path and a direction of a vehicle are not limited, thereby improving the universality of parking space detection.

Description

一种车位检测方法、装置、介质和设备Parking space detection method, device, medium and equipment 技术领域Technical field
本发明涉及自动泊车技术领域,特别涉及一种车位检测方法、装置、介质和设备。The invention relates to the technical field of automatic parking, in particular to a parking space detection method, device, medium and equipment.
背景技术Background technique
全自动泊车的首要步骤就是检测车位。在现有技术中,车位检测是通过车周的超声波雷达,沿车辆行驶路径进行搜索,从行驶路径两侧的待检测区域中发现可停车区域。The first step in fully automatic parking is to detect parking spaces. In the prior art, the parking space detection is carried out by using the ultrasonic radar around the vehicle to search along the vehicle travel path, and the parkingable areas are found from the areas to be detected on both sides of the travel path.
但是,现有技术方案中,对车辆行驶路径有一定的要求,通常需要行驶路径与待检测区域保持平行,且在车辆转向、倒车过程中,无法进行车位检测。However, in the prior art solutions, there are certain requirements for the vehicle travel path. Generally, the travel path needs to be kept parallel to the area to be detected, and the parking space cannot be detected during the turning and reversing process of the vehicle.
发明内容Summary of the invention
本发明实施例提供一种车位检测方法、装置、介质和设备,用于解决车位检测过程中,车辆行驶路径和方向受限的问题。Embodiments of the present invention provide a method, a device, a medium, and a device for detecting a parking space, which are used to solve a problem that a vehicle travel path and direction are limited during the parking space detection process.
一种车位检测方法,车辆左右两侧的指定位置均安装有一个超声波雷达,所述方法包括:A parking space detection method in which an ultrasonic radar is installed at designated positions on the left and right sides of a vehicle. The method includes:
若确定所述车辆发生了移动,则针对车辆左侧和右侧,分别确定对应的超声波雷达检测到的每个障碍物上的点的坐标值;并分别针对车辆左侧和右侧,根据障碍物上的点到对应的超声波雷达的距离,对障碍物上的点进行分组;If it is determined that the vehicle has moved, the coordinate values of points on each obstacle detected by the corresponding ultrasonic radar are determined respectively for the left and right sides of the vehicle; and the left and right sides of the vehicle are respectively determined according to the obstacles. The distance from the points on the object to the corresponding ultrasonic radar to group the points on the obstacle;
根据一个分组中每个障碍物上的点的坐标值,进行线段拟合,并根据该分组中具有二次回波的障碍物上的点的比例,确定拟合出的线段的高低属性,所述高低属性由于描述组成所述线段的障碍物上的点来源于高物体还是低物体;According to the coordinate values of the points on each obstacle in a group, line segment fitting is performed, and according to the ratio of the points on the obstacle with the secondary echo in the group, the height attribute of the fitted line segment is determined. The high and low attributes describe whether the points on the obstacles that make up the line segment originate from high or low objects;
分别针对车辆左侧和右侧对应的线段,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位。For the line segments corresponding to the left and right sides of the vehicle, a model matching method is used to determine whether there is a parking space between two adjacent high attribute line segments.
一种车位检测装置,所述装置包括:A parking space detection device, the device includes:
坐标确定模块,用于若确定车辆发生了移动,则针对车辆左侧和右侧,分别确定对应的超声波雷达检测到的每个障碍物上的点的坐标值;A coordinate determining module, configured to determine the coordinate values of points on each obstacle detected by a corresponding ultrasonic radar for the left and right sides of the vehicle if it is determined that the vehicle has moved;
分组模块,用于分别针对车辆左侧和右侧,根据障碍物上的点到对应的超声波雷达的距离,对障碍物上的点进行分组;A grouping module is used to group the points on the obstacle according to the distance from the point on the obstacle to the corresponding ultrasonic radar respectively for the left and right sides of the vehicle;
线段拟合模块,用于根据一个分组中每个障碍物上的点的坐标值,进行线段拟合;The line segment fitting module is used for line segment fitting according to the coordinate values of points on each obstacle in a group;
属性赋值模块,用于根据一个分组中具有二次回波的障碍物上的点的比例,确定拟合出的线段的高低属性,所述高低属性由于描述组成所述线段的障碍物上的点来源于高物体还是低物体;An attribute assignment module is used to determine the height attribute of the fitted line segment according to the proportion of the points on the obstacle having the secondary echo in a group. The height attribute describes the source of the points on the obstacle constituting the line segment. Whether it is high or low;
识别模块,用于分别针对车辆左侧和右侧对应的线段,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位。A recognition module is used to determine whether there is a parking space between two adjacent high attribute line segments for the corresponding line segments on the left and right sides of the vehicle through a model matching method.
本发明还提供了一种非易失性计算机存储介质,所述计算机存储介质存储有可执行程序,该可执行程序被处理器执行实现如上所述方法的步骤。The present invention also provides a non-volatile computer storage medium. The computer storage medium stores an executable program, and the executable program is executed by a processor to implement the steps of the method described above.
本发明还提供了一种车位检测设备,包括存储器、处理器及存储在存储器上的计算机程序,所述处理器执行所述程序时实现如上所述方法的步骤。The invention also provides a parking space detection device, which includes a memory, a processor, and a computer program stored on the memory. When the processor executes the program, the steps of the method described above are implemented.
根据本发明实施例提供的方案,可以分别对车辆左右两侧的超声波雷达探测到的障碍物上的点,进行聚类和分段拟合,从而获得车辆左右两侧分别对应的障碍物线段集合,并赋予线段高低属性,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位。本发明实施例提供的方案中,对车辆行驶路径和方向均无限制,提高了车位检测的普适性。According to the solution provided by the embodiment of the present invention, the points on the obstacles detected by the ultrasonic radars on the left and right sides of the vehicle can be clustered and segmented to obtain the sets of obstacle line segments corresponding to the left and right sides of the vehicle, respectively. , And assign line segment high and low attributes, and determine whether there is a parking space between two adjacent high attribute line segments through a model matching method. In the solution provided by the embodiment of the present invention, there are no restrictions on the travel path and direction of the vehicle, which improves the universality of parking space detection.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly explain the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly introduced below. Obviously, the drawings in the following description are merely These are some embodiments of the present invention. For those of ordinary skill in the art, other drawings can be obtained based on these drawings without paying creative labor.
图1为本发明实施例一提供的车位检测方法的流程示意图;1 is a schematic flowchart of a parking space detection method according to a first embodiment of the present invention;
图2为本发明实施例一提供的坐标系示意图;2 is a schematic diagram of a coordinate system provided by Embodiment 1 of the present invention;
图3为本发明实施例一提供的障碍物点距离突变示意图;3 is a schematic diagram of a sudden change in obstacle point distance provided by Embodiment 1 of the present invention;
图4为本发明实施例一提供的平行车位示意图;4 is a schematic diagram of a parallel parking space provided by Embodiment 1 of the present invention;
图5为本发明实施例一提供的垂直车位示意图;5 is a schematic diagram of a vertical parking space provided by Embodiment 1 of the present invention;
图6为本发明实施例一提供的相邻两条高属性的线段之间的夹角和横向深度距离示意图;FIG. 6 is a schematic diagram of an included angle and a lateral depth distance between two adjacent high-performance line segments provided in Embodiment 1 of the present invention; FIG.
图7为本发明实施例一提供的平行车位对应的轮廓描述和目标位姿示意图;FIG. 7 is a contour description and a target posture corresponding to a parallel parking space provided in Embodiment 1 of the present invention; FIG.
图8为本发明实施例一提供的垂直车位对应的轮廓描述和目标位姿示意图;FIG. 8 is a contour description and a target posture of a vertical parking space provided by Embodiment 1 of the present invention; FIG.
图9为本发明实施例二提供的车位识别方法的流程示意图;FIG. 9 is a schematic flowchart of a parking space identification method according to a second embodiment of the present invention; FIG.
图10为本发明实施例三提供的车位检测装置的结构示意图;10 is a schematic structural diagram of a parking space detection device according to a third embodiment of the present invention;
图11为本发明实施例四提供的车位检测设备的结构示意图。FIG. 11 is a schematic structural diagram of a parking space detection device according to a fourth embodiment of the present invention.
具体实施方式detailed description
在本发明各实施例中,车辆左右两侧的障碍物上的点组成的线段所描述的空间,可以称为可达空间。本发明提供的车位检测方案,可以在可达空间进行循环遍历,搜索车辆行驶过程中的所有车位,同时将左右两侧的车位都识别出来。且车位检测过程中,对行驶路径没有过多要求,在车辆转向、倒车过程中同样可以进行车位检测。In each embodiment of the present invention, a space described by a line segment composed of points on obstacles on the left and right sides of the vehicle may be referred to as an accessible space. The parking space detection scheme provided by the present invention can circulate and traverse in the accessible space, search all the parking spaces during the driving process of the vehicle, and simultaneously recognize the parking spaces on the left and right sides. Moreover, there is no excessive requirement on the driving path during the parking space detection process, and the parking space detection can also be performed during the turning and reversing of the vehicle.
同时,在本发明提供的方案中,通过安装在指定位置的超声波雷达,可以对路沿进行识别,对当前车辆以及目标车位之间的障碍物可以有比较完整的描述。At the same time, in the solution provided by the present invention, the roadside can be identified by the ultrasonic radar installed at a specified position, and the obstacle between the current vehicle and the target parking space can be described more completely.
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步地详细描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the objectives, technical solutions, and advantages of the present invention clearer, the present invention will be described in further detail below with reference to the accompanying drawings. Obviously, the described embodiments are only a part of the embodiments of the present invention, rather than all the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by a person of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention.
需要说明的是,本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括” 和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。It should be noted that the terms “first” and “second” in the description and claims of the present invention and the above drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way are interchangeable where appropriate, so that the embodiments of the invention described herein can be implemented in an order other than those illustrated or described herein. Furthermore, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions, for example, a process, method, system, product, or device that includes a series of steps or units need not be limited to those explicitly listed Those steps or units may instead include other steps or units not explicitly listed or inherent to these processes, methods, products or equipment.
实施例一Example one
本发明实施例一提供一种车位检测方法,该方法的步骤流程可以如图1所示,包括:The first embodiment of the present invention provides a parking space detection method. The steps of the method can be shown in FIG. 1 and includes:
步骤101、确定车辆是否发生移动。Step 101: Determine whether the vehicle moves.
在本实施例中,可以在车辆发生移动时,触发车位检测。因此,在本步骤中,可以确定车辆是否发生了移动,若确定车辆发生了移动,则可以继续执行步骤102。In this embodiment, when the vehicle moves, the parking space detection may be triggered. Therefore, in this step, it can be determined whether the vehicle has moved, and if it is determined that the vehicle has moved, step 102 can be continued.
具体的,可以但不限于通过车辆位姿是否发生变化,来确定车辆是否发生了移动。车辆位姿可以理解为包括车辆中心点坐标和车辆横摆角。Specifically, it may be determined, but not limited to, whether the vehicle moves according to whether the posture of the vehicle changes. The vehicle posture can be understood as including vehicle center point coordinates and vehicle yaw angle.
如图2所示,假设全局绝对平面坐标系为oxy,车辆局部坐标系为o’x’y’。车辆中心点坐标可以为车辆后轮轴中心点坐标,则车辆位姿包括车辆后轮轴中心点坐标(即车辆局部坐标系中坐标原点o′点坐标)和车辆横摆角(θ 0),车辆位姿在全局绝对平面坐标系下可以表示为(x 0,y 0,θ 0)。车辆位姿可以根据轮脉冲、惯性测量单元(IMU)、方向转角等信号输入,利用车辆累计航位推算公式确定。 As shown in FIG. 2, it is assumed that the global absolute plane coordinate system is oxy, and the vehicle local coordinate system is o'x'y '. The coordinates of the center point of the vehicle may be the coordinates of the center point of the rear wheel axis of the vehicle. The vehicle pose includes the center point coordinates of the rear wheel axis of the vehicle (that is, the coordinate origin o ′ point coordinate in the local coordinate system of the vehicle) and the vehicle yaw angle (θ 0 ). The pose can be expressed as (x 0 , y 0 , θ 0 ) in the global absolute plane coordinate system. The vehicle posture can be determined based on the wheel pulse, inertial measurement unit (IMU), directional turning angle and other signal inputs, using the vehicle's accumulated dead reckoning formula.
步骤102、确定障碍物上的点的坐标值。Step 102: Determine coordinate values of points on the obstacle.
在本步骤中,若确定所述车辆发生了移动,则可以针对车辆左侧和右侧,分别确定对应的超声波雷达检测到的每个障碍物上的点的坐标值。每个障碍物上的点的坐标值可以通过任意方式确定,例如,每个障碍物上的点的坐标值可以但不限于通过所述车辆的位姿,该障碍物上的点到对应的超声波雷达的距离,以及该超声波雷达在所述车辆上的安装位置确定。In this step, if it is determined that the vehicle has moved, the coordinate values of points on each obstacle detected by the corresponding ultrasonic radar may be determined respectively for the left and right sides of the vehicle. The coordinate value of the point on each obstacle can be determined in any way. For example, the coordinate value of the point on each obstacle can be, but is not limited to, the position and posture of the vehicle. The point on the obstacle reaches the corresponding ultrasonic wave. The distance of the radar and the installation position of the ultrasonic radar on the vehicle are determined.
需要说明的是,在本实施例中,为了实现障碍物上的点的检测,超声波雷达需要安装在车辆左右两侧的指定位置。It should be noted that, in this embodiment, in order to detect points on an obstacle, the ultrasonic radar needs to be installed at designated positions on the left and right sides of the vehicle.
较优的,超声波雷达可以但不限于安装在车辆前轮轮眉上,垂直于车身轴线,且离地高度为指定高度,指定高度可以根据不同超声波雷达的特性设定,相对于后轮轴中心o′的安装尺寸为L x,L y。车辆右侧超声波雷达的安装位置可以如图2所示。超声波雷达探测到的障碍物上的点,到该超声波雷达的距离可以用d表示。为统一左右两侧障碍物点计算公式,L y与d的符号均可以规定为车辆前进方向的左侧为负,右侧为正,L x的符号可以规定均为正。那么对应障碍物上的点P在全局绝对平面坐标系oxy下的坐标(x p,y p)计算公式可以表示为: Preferably, the ultrasonic radar can be installed on the front wheel eyebrows of the vehicle, is perpendicular to the vehicle body axis, and the height above the ground is a specified height. The specified height can be set according to the characteristics of different ultrasonic radars, relative to the center of the rear wheel shaft. dimensions' of L x, L y. The installation position of the ultrasonic radar on the right side of the vehicle can be shown in Figure 2. The point on the obstacle detected by the ultrasonic radar, and the distance to the ultrasonic radar can be expressed by d. In order to unify the calculation formulas of the obstacle points on the left and right sides, the symbols of Ly and d can be specified as the left side of the vehicle's forward direction is negative, the right side is positive, and the sign of L x can be specified as both positive. Then the coordinate formula (x p , y p ) of the point P on the obstacle in the global absolute plane coordinate system oxy can be expressed as:
Figure PCTCN2019093486-appb-000001
Figure PCTCN2019093486-appb-000001
步骤103、对障碍物上的点进行分组。Step 103: Group the points on the obstacle.
需要说明的是,步骤102和步骤103执行不分先后。在本实施例中,以步骤103在步骤102之后执行为例,进行说明。It should be noted that step 102 and step 103 are performed in no particular order. In this embodiment, description is made by taking step 103 to be performed after step 102 as an example.
考虑到超声波雷达检测到的是障碍物的轮廓点,障碍物的轮廓一般不会发生突变,因此在检测出的 障碍物上的点到对应的超声波雷达的距离发生突变时,可以理解为该点所属的障碍物发生了变化。因此,在本实施例中,可以根据距离是否发生突变,对属于不同障碍物的点进行分组,实现对障碍物上的点的聚类。Considering that the ultrasonic radar detects the contour point of the obstacle, the contour of the obstacle does not change suddenly, so when the distance between the detected obstacle and the corresponding ultrasonic radar changes suddenly, it can be understood as the point The belonging obstacle has changed. Therefore, in this embodiment, the points belonging to different obstacles can be grouped according to whether the distance is abruptly changed, and the points on the obstacles can be clustered.
在本步骤中,可以分别针对车辆左侧和右侧,根据障碍物上的点到对应的超声波雷达的距离,对障碍物上的点进行分组。In this step, the points on the obstacle can be grouped for the left and right sides of the vehicle respectively according to the distance from the points on the obstacle to the corresponding ultrasonic radar.
具体的,在本步骤中,可以分别针对车辆左侧和右侧,在当前检测到的障碍物上的点到对应的超声波雷达的距离,与该障碍物上的点之前相邻检测到的障碍物上的点到该超声波雷达的距离之间,差值的绝对值大于设定值时,将当前检测到的障碍物上的点之前,未被分组的障碍物上的点划分为一个分组。Specifically, in this step, the distance from the point on the currently detected obstacle to the corresponding ultrasonic radar for the left and right sides of the vehicle, respectively, and the obstacle detected adjacent to the point on the obstacle before When the absolute value of the difference between the point on the object and the ultrasonic radar is greater than the set value, the points on the obstacle that are not grouped before the currently detected obstacle are divided into a group.
例如,如图3所示为探测到的障碍物上的点距离突变示意图。进行车位检测的车辆先后经过1号车辆,路沿和2号车辆,可以扫描到如图3所示意的障碍物轮廓点。可以发现在车辆连续行进过程中,对于同一个障碍物扫描获得的点集中,相邻两点之间的距离变化不大。而对于不同的障碍物,在边缘处,相邻两点之间的距离会发生突变,例如P(m)与P(m+1),P(n)与P(n+1)。因此,可以对扫描到的所有点进行聚类,以图3为例,可以聚类为3个分组。For example, as shown in FIG. 3, a point distance abrupt change on an obstacle is detected. Vehicles for parking space detection can pass through No. 1 vehicle, roadside and No. 2 vehicle, and can scan the obstacle contour points as shown in FIG. 3. It can be found that during the continuous travel of the vehicle, for the point concentration obtained by scanning the same obstacle, the distance between two adjacent points does not change much. For different obstacles, the distance between two adjacent points at the edge will change abruptly, such as P (m) and P (m + 1), P (n) and P (n + 1). Therefore, all the scanned points can be clustered. Taking FIG. 3 as an example, clustering can be performed into three groups.
当然,如果障碍物消失,超声波雷达没有检测到障碍物上的点,那么超声波雷达探测到的距离为最大量程值,此时,也可以理解为探测到的障碍物上的点距离,相对于上一个障碍物上的点,发生了突变。Of course, if the obstacle disappears and the ultrasonic radar does not detect the point on the obstacle, then the distance detected by the ultrasonic radar is the maximum range value. At this time, it can also be understood as the distance of the point on the detected obstacle. A point on an obstacle was mutated.
步骤104、进行线段拟合。Step 104: Perform line segment fitting.
在本步骤中,可以根据一个分组中每个障碍物上的点的坐标值,进行线段拟合。In this step, line segment fitting can be performed according to the coordinate values of points on each obstacle in a group.
仍以图3为例,针对每个分组进行线段拟合,可以得到描述障碍物轮廓的3条线段l1,l2,l3,其中l1,l2为车身轮廓,l3为路沿轮廓。Still taking FIG. 3 as an example, line segment fitting is performed for each group, and three line segments l1, l2, and l3 describing the outline of the obstacle can be obtained, where l1, l2 are body contours, and l3 is road contour.
在进行线段拟合之后,可以将获取的每个障碍物上的点相关信息,如坐标值、距离等删除,以节约存储空间。After performing line segment fitting, the obtained point-related information on each obstacle, such as coordinate values and distances, can be deleted to save storage space.
步骤105、线段属性赋值。Step 105: Assign a line segment attribute.
发明人在试验中发现,每个障碍物上的点除了对应超声波雷达当时的直接测量值(一次回波)之外,还可能存在二次回波。在超声波雷达扫描较高的障碍物(如,车辆)时,二次回波的比例较高,在扫描较低的障碍物(如,路沿)时,二次回波的比例较低。The inventor found in the experiment that in addition to the direct measurement value (primary echo) of the ultrasonic radar at that time, the points on each obstacle may also have secondary echoes. When the ultrasonic radar scans a higher obstacle (such as a vehicle), the ratio of the secondary echo is higher, and when a lower obstacle (such as a road edge) is scanned, the ratio of the secondary echo is lower.
需要说明的是,本发明各实施例中涉及的超声波雷达具有二次回波探测能力。因此,在本步骤中,可以根据每个分组中具有二次回波的障碍物上的点的比例,确定拟合出的线段的高低属性,所述高低属性由于描述组成所述线段的障碍物上的点来源于高物体还是低物体。It should be noted that the ultrasonic radar involved in the embodiments of the present invention has a secondary echo detection capability. Therefore, in this step, the height attribute of the fitted line segment can be determined according to the ratio of points on the obstacle with the secondary echo in each group. The height attribute is described by the obstacles constituting the line segment. The points come from high or low objects.
在确定线段的高低属性时,可以将具有二次回波的障碍物上的点的比例大于特定值的分组,对应拟合出的线段确定为高属性,将不大于特定值的分组,对应拟合出的线段确定为低属性。较优的,通过实验测试,所述特定值可以为60%。当然,所述特定值可以根据超声波雷达的实际检测能力进行调整。When determining the high and low attributes of a line segment, the proportion of points on an obstacle with a secondary echo greater than a specific value can be grouped, and the corresponding line segment is determined to be a high attribute. The outgoing line segment is determined as a low attribute. Preferably, the specific value may be 60% through an experimental test. Of course, the specific value can be adjusted according to the actual detection capability of the ultrasonic radar.
当然,优选的,线段还可以进一步理解为包括左右属性,所述左右属性由于描述组成所述线段的障碍物上的点来源于车辆左侧还是车辆右侧。Of course, preferably, the line segment can be further understood as including left and right attributes. The left and right attributes are described as whether the points on the obstacles constituting the line segment originate from the left side or the right side of the vehicle.
在本步骤中,优选的,还可以将具有右属性的线段加入右侧线段集合,将具有左属性的线段加入左侧线段集合,以便于后续分别根据右侧线段集合和左侧线段集合进行车位识别。In this step, preferably, a line segment with a right attribute can also be added to a right line segment set, and a line segment with a left attribute can be added to a left line segment set, so as to facilitate subsequent parking spaces according to the right line segment set and the left line segment set. Identify.
步骤106、车位识别。Step 106, parking space identification.
在本步骤中,可以分别针对车辆左侧和右侧对应的线段,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位。In this step, for the line segments corresponding to the left and right sides of the vehicle, a model matching method can be used to determine whether there is a parking space between two adjacent high attribute line segments.
如图4所示,车辆一侧的车位可能为平行车位。此时,具体的,可以但不限于通过以下方式确定相邻两条高属性线段之间,是否存在车位:As shown in FIG. 4, the parking space on one side of the vehicle may be a parallel parking space. At this time, specifically, it is possible, but not limited to, to determine whether there is a parking space between two adjacent high attribute line segments by:
若相邻两条高属性线段之间还包括低属性线段,则确定该低属性线段与所述相邻两条高属性线段中至少一条之间的横向深度距离,与所述车辆的车宽之间的差值是否大于第一门限值;以及,确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车长之间的差值是否大于第二门限值;If a low attribute line segment is also included between two adjacent high attribute line segments, determine a lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and Whether the difference between them is greater than the first threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high-performance line segments and the vehicle length of the vehicle is greater than the second threshold value;
若所述横向深度距离与所述车辆的车宽之间的差值大于第一门限值,且所述纵向长度距离与所述车辆的车长之间的差值大于第二门限值,则确定相邻两条高属性线段之间,存在至少一个车位;或者,If the difference between the lateral depth distance and the vehicle width of the vehicle is greater than a first threshold value, and the difference between the longitudinal length distance and the vehicle length of the vehicle is greater than a second threshold value, Then determine that there is at least one parking space between two adjacent high attribute line segments; or
若相邻两条高属性线段之间不包括低属性线段,则确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车长之间的差值是否大于第二门限值,若是,则确定相邻两条高属性线段之间,存在至少一个车位。If a low attribute line segment is not included between two adjacent high attribute line segments, determine whether a difference between a longitudinal length distance between the adjacent two high attribute line segments and a vehicle length of the vehicle is greater than a second door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
若相邻两条高属性线段之间还包括低属性线段的情况,可以理解为相邻两条高属性线段对应的障碍物之间,还存在一个低属性线段对应的障碍物,则此时,需要判断三条线段对应的空间的宽(dp,横向深度距离)和长(L3,纵向长度距离)是否满足进行车位检测的车辆的车宽和车长需求,是否可以作为一个车位使用。If two adjacent high-attribute line segments also include a low-attribute line segment, it can be understood that there is an obstacle corresponding to a low-attribute line segment between two adjacent high-attribution line segments. At this time, It is necessary to determine whether the width (dp, lateral depth distance) and length (L3, longitudinal length distance) of the space corresponding to the three line segments meet the requirements of the width and length of the vehicle for parking space detection, and whether it can be used as a parking space.
若相邻两条高属性线段之间不包括低属性线段的情况,可以理解为相邻两条高属性线段对应的障碍物之间,不存在其他障碍物,则此时可以理解为宽度足以满足进行车位检测的车辆的车宽需求,只需要判断两条线段对应的空间的长(L3)是否满足进行车位检测的车辆的车长需求,是否可以作为一个车位使用。If the low attribute line segment is not included between two adjacent high attribute line segments, it can be understood that there are no other obstacles between the obstacles corresponding to the adjacent two high attribute line segments, then it can be understood that the width is sufficient to satisfy The width requirement of the vehicle for parking space detection only needs to determine whether the length (L3) of the space corresponding to the two line segments meets the vehicle length requirement of the vehicle for parking space detection and whether it can be used as a parking space.
较优的,所述第一门限值可以为0.3米,第二门限值可以为0.8米。Preferably, the first threshold value may be 0.3 meters, and the second threshold value may be 0.8 meters.
进一步的,为了减少车位的误检测,可以进一步确定相邻两条高属性的线段长度均大于第一指定值,从而提高相邻两条高属性的线段对应的障碍物为车辆的概率,进而提高检测出的区域为车位的准确性。Further, in order to reduce the false detection of parking spaces, it is possible to further determine that the lengths of the two adjacent high-level line segments are greater than the first specified value, thereby increasing the probability that the obstacles corresponding to the two adjacent high-level line segments are vehicles, thereby increasing The detected area is the accuracy of the parking space.
较优的,所述第一指定值可以为0.8倍的进行车位检测的车辆的车长。Preferably, the first specified value may be 0.8 times the length of the vehicle of the vehicle for which parking space is detected.
如图5所示,车辆一侧的车位也可能为垂直车位。此时,具体的,可以但不限于通过以下方式确定相邻两条高属性线段之间,是否存在车位:As shown in FIG. 5, the parking space on the side of the vehicle may also be a vertical parking space. At this time, specifically, it is possible, but not limited to, to determine whether there is a parking space between two adjacent high attribute line segments by:
若相邻两条高属性线段之间还包括低属性线段,则确定该低属性线段与所述相邻两条高属性线段中至少一条之间的横向深度距离,与所述车辆的车长之间的差值是否大于第三门限值;以及确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车宽之间的差值是否大于第四门限值;If a low attribute line segment is also included between two adjacent high attribute line segments, determine the lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and the length of the vehicle Whether the difference between them is greater than the third threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high attribute line segments and the width of the vehicle is greater than the fourth threshold value;
若所述横向深度距离与所述车辆的车长之间的差值大于所述第三门限值,且所述纵向长度距离与所述车辆的车宽之间的差值大于第四门限值,则确定相邻两条高属性线段之间,存在至少一个车位;或者,If the difference between the lateral depth distance and the vehicle length of the vehicle is greater than the third threshold value, and the difference between the longitudinal length distance and the vehicle width of the vehicle is greater than a fourth threshold value Value, determine that there is at least one parking space between two adjacent high attribute line segments; or,
若相邻两条高属性线段之间不包括低属性线段,则确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车宽之间的差值是否大于第四门限值,若是,则确定相邻两条高属性线段之间,存在至少 一个车位。If the low attribute line segment is not included between two adjacent high attribute line segments, determine whether the difference between the longitudinal length distance between the adjacent two high attribute line segments and the vehicle width of the vehicle is greater than the fourth door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
与平行车位类似的,若相邻两条高属性线段之间还包括低属性线段的情况,则此时,需要判断三条线段对应的空间的深度(dp,横向深度距离)和宽度(L3,纵向长度距离)是否满足进行车位检测的车辆的车长和车宽需求,是否可以作为一个车位使用。Similar to parallel parking spaces, if there are low-attribute line segments between two adjacent high-attribute line segments, then at this time, you need to determine the depth (dp, lateral depth distance) and width (L3, longitudinal direction) of the space corresponding to the three line segments. Length distance) whether it meets the requirements of the length and width of the vehicle for parking space detection, and whether it can be used as a parking space.
若相邻两条高属性线段之间不包括低属性线段的情况,则此时可以理解为深度足以满足进行车位检测的车辆的车长需求,只需要判断两条线段对应的空间的宽度(L3)是否满足进行车位检测的车辆的车宽需求,是否可以作为一个车位使用。If there are no low-attribute line segments between two adjacent high-attribution line segments, it can be understood at this time that the depth is sufficient to meet the vehicle length requirements of the vehicle for parking space detection, and only the width of the space corresponding to the two line segments (L3 ) Whether the vehicle width requirement of the vehicle for parking space detection is met, and whether it can be used as a parking space.
较优的,所述第三门限值可以为0.3米,第四门限值可以为0.6米。Preferably, the third threshold value may be 0.3 meters, and the fourth threshold value may be 0.6 meters.
进一步的,为了减少车位的误检测,可以进一步确定相邻两条高属性的线段长度均大于第二指定值。较优的,所述第二指定值可以为0.8倍的进行车位检测的车辆的车宽。Further, in order to reduce the false detection of the parking space, it may be further determined that the lengths of two adjacent line segments with high attributes are both larger than the second specified value. Preferably, the second specified value may be 0.8 times the vehicle width of the vehicle for which parking space is detected.
而不论针对平行车位,还是垂直车位,为了更进一步地减少车位的误检测,还可以进一步确定相邻两条高属性的线段之间的夹角小于第一阈值,以及相邻两条高属性的线段之间的横向深度距离小于第二阈值。Regardless of the parallel parking space or the vertical parking space, in order to further reduce the false detection of parking spaces, it can be further determined that the included angle between two adjacent high-level line segments is less than the first threshold, and the The lateral depth distance between the line segments is less than a second threshold.
图6为相邻两条高属性的线段之间的夹角和横向深度距离示意图,相邻两条高属性的线段之间的夹角θ 12,可以理解为延长L1,L2得到的夹角。作夹角的角平分线LA,分别过L1,L2的中点作LA的垂线,得到距离d1,d2,那么L1,L2的横向距离深度距离d 12定义为d1,d2之间差值的绝对值:d 12=|d1-d2|。 FIG. 6 is a schematic diagram of an included angle and a lateral depth distance between two adjacent high attribute line segments. The included angle θ 12 between two adjacent high attribute line segments can be understood as an included angle obtained by extending L1 and L2. The angle bisector LA as the included angle passes through the midpoints of L1 and L2 as the vertical line of LA to obtain the distance d1 and d2. Then the lateral distance and depth distance d 12 of L1 and L2 are defined as the difference between d1 and d2. Absolute value: d 12 = | d1-d2 |.
较优的,所述第一阈值可以为25度,所述第二阈值可以为1米。Preferably, the first threshold may be 25 degrees, and the second threshold may be 1 meter.
当然,上述各门限值、指定值、阈值均可以根据进行车位检测的车辆的几何尺寸参数以及转向能力进行调整。Of course, the above-mentioned thresholds, designated values, and thresholds can all be adjusted according to the geometric size parameters and the steering capability of the vehicle performing the parking space detection.
此外,需要说明的是,在本步骤中,进行车位识别时,仅规定了各参数的下限,使得识别出的车位至少可以满足停放进行车位检测的车辆的要求。而根据不同的功能产品定义,还可以设置各参数的上限,从而可以进一步确定出,识别出的车位可以停放的车辆的具体数量,本实施例不再进一步说明。In addition, it should be noted that in this step, only the lower limit of each parameter is specified when performing parking space identification, so that the identified parking space can at least meet the requirements for parking a vehicle for parking space detection. According to the definition of different functional products, the upper limit of each parameter can also be set, so that the specific number of vehicles that can be parked in the identified parking space can be further determined, which will not be further described in this embodiment.
步骤107、确定车位信息。Step 107: Determine parking space information.
在识别出车位之后,还可以进一步确定相邻两条高属性线段之间存在的车位所对应的轮廓描述,所述轮廓描述用于说明所述车位所在的位置,和/或者,确定所述车位所对应的所述车辆的目标位姿,使得后续自动泊车时,可以根据确定出的轮廓描述和/或目标位姿,自动泊入该车位。After the parking space is identified, a contour description corresponding to the parking space existing between two adjacent high attribute line segments may be further determined, and the contour description is used to describe the location of the parking space, and / or, the parking space is determined The corresponding target posture of the vehicle enables automatic parking in the parking space according to the determined contour description and / or target posture during subsequent automatic parking.
在确定轮廓描述和/或目标位姿之后,还可以对确定出的轮廓描述和/或目标位姿进行输出,以便于查看。After determining the contour description and / or the target pose, the determined contour description and / or the target pose may be output for easy viewing.
如图7所示,为平行车位对应的轮廓描述和目标位姿示意图。类似的,如图8所示,为垂直车位对应的轮廓描述和目标位姿示意图。As shown in FIG. 7, it is a contour description and a target posture diagram corresponding to parallel parking spaces. Similarly, as shown in FIG. 8, it is a contour description and a target posture diagram corresponding to a vertical parking space.
在本实施例中,车位轮廓描述可以但不限于为A、B、C、D、E、F六个点对应的五条线段,即可以利用AB、BC、CD、DE、EF五条线段来描述车位轮廓,以便于路径规划的实现。In this embodiment, the parking space outline description may be, but is not limited to, five line segments corresponding to the six points A, B, C, D, E, and F, that is, the five line segments AB, BC, CD, DE, and EF may be used to describe the parking space. Outline to facilitate path planning.
具体的,如果相邻两条高属性线段之间不存在低属性线段,由于实际上车位没有对C、D顶点位置的限定,那么可以根据需要任意确定C、D的坐标取值。例如,在平行车位中,根据BC长度为车宽加 0.3米,确定C点坐标,根据DE长度为车宽加0.3米,确定D点坐标。又如,在垂直车位中,根据BC长度为车长加0.3米,确定C点坐标,根据DE长度为车长加0.3米,确定D点坐标。在确定C、D的坐标取值之后,即可以利用AB、BC、CD、DE、EF五条线段来描述车位轮廓。Specifically, if there are no low-attribute line segments between two adjacent high-attribution line segments, since there is actually no restriction on the positions of the C and D vertices in the parking space, the values of the coordinates of C and D can be arbitrarily determined as required. For example, in parallel parking spaces, the coordinates of point C are determined based on the length of the BC plus 0.3 meters, and the coordinates of the point D are determined based on the length of the DE plus 0.3 meters. For another example, in the vertical parking space, the coordinates of the point C are determined according to the length of the BC plus 0.3 meters, and the coordinates of the point D are determined according to the length of the DE plus 0.3 meters. After determining the coordinate values of C and D, five line segments AB, BC, CD, DE, and EF can be used to describe the parking space contour.
目标位姿可以以目标车辆中心坐标(P点坐标,如,车辆后轮轴中心点坐标)以及过P点的箭头方向(对应目标横摆角)来表示,在全局绝对平面坐标系下可以表示为(x p,y p,θ p)。 The target pose can be expressed in the coordinates of the target vehicle center (point P coordinates, such as the center point of the rear wheel axis of the vehicle) and the direction of the arrow passing through point P (corresponding to the target yaw angle). In the global absolute plane coordinate system, it can be expressed as (x p , y p , θ p ).
根据最终的停车策略不同,目标横摆角θ p的确定方式也可能是不同的,例如,对于平行车位,最终的停车策略可以为过P点的箭头方向与AB、CD、EF中的任意一条线段保持平行,以过P点的箭头方向与AB保持平行为例,那么θ p可以表示为: Depending on the final parking strategy, the determination method of the target yaw angle θ p may also be different. For example, for parallel parking spaces, the final parking strategy can be the direction of the arrow passing point P and any of AB, CD, and EF. The line segment remains parallel. Taking the direction of the arrow passing point P and AB as an example, then θ p can be expressed as:
θ p=a tan 2(y B-y A,x B-x A) θ p = a tan 2 (y B -y A , x B -x A )
需要说明的是,atan2(Δy,Δx)是C语言函数中的一种计算反正切的函数,相比较arctan(Δy/Δx)而言,可以获得更稳定的计算结果。It should be noted that atan2 (Δy, Δx) is a function for calculating the arc tangent in the C language function. Compared with arctan (Δy / Δx), a more stable calculation result is obtained.
当Δy的绝对值远大于Δx时,arctan(Δy/Δx)函数的计算结果是不稳定的。atan2(Δy,Δx)的做法是,当Δx的绝对值比Δy的绝对值大时,使用arctan(Δy/Δx);反之使用arctan(Δx/Δy),从而保证确定出的数值的稳定性。When the absolute value of Δy is much larger than Δx, the calculation result of the arctan (Δy / Δx) function is unstable. The practice of atan2 (Δy, Δx) is to use arctan (Δy / Δx) when the absolute value of Δx is greater than the absolute value of Δy; otherwise, use arctan (Δx / Δy) to ensure the stability of the determined value.
根据设定的P点在车辆上的位置,以及车辆在车位中的停车策略,P点坐标(x p,y p)可以但不限于通过B、C、D、E四个顶点坐标确定。 According to the set position of the point P on the vehicle and the parking strategy of the vehicle in the parking space, the coordinates of the point P (x p , y p ) can be determined by, but not limited to, the four vertex coordinates of B, C, D, and E.
下面通过一个具体的实例对本发明实施例一提供的方案中的步骤106进行说明。In the following, a specific example is used to describe step 106 in the solution provided by the first embodiment of the present invention.
实施例二Example two
本发明实施例二提供一种车位识别方法,该方法的步骤流程可以如图9所示,包括:The second embodiment of the present invention provides a parking space identification method. The step flow of the method can be shown in FIG. 9 and includes:
步骤201、从线段集的第一条线段开始搜索。Step 201: Start searching from the first line segment of the line segment set.
在本实施例中,假设具有左属性和具有右属性的线段在同一个线段集合中,后续可以通过线段的左右属性,判断线段来自车辆左侧还是车辆右侧。此时,可以理解为i=1,i表示线段集中的线段序号。In this embodiment, it is assumed that the line segment with the left attribute and the line segment with the right attribute are in the same line segment set, and the left and right attributes of the line segment can be used to determine whether the line segment is from the left side or the right side of the vehicle. At this time, it can be understood as i = 1, and i represents the number of the line segment in the line segment set.
当然,也可以针对车辆左侧对应的线段,进行左侧车位的识别,针对车辆右侧对应的线段,进行右侧车位的识别,即,分别进行左右两侧车位的识别。Of course, it is also possible to identify the left parking space for the line segment corresponding to the left side of the vehicle and the right parking space for the line segment corresponding to the right side of the vehicle, that is, to identify the left and right parking spaces respectively.
步骤202、判断线段是否为高属性。Step 202: Determine whether the line segment has a high attribute.
如果是,则继续步骤203,否则,将线段序号加1,继续执行本步骤。If yes, continue to step 203; otherwise, increase the line segment number by 1 and continue with this step.
步骤203、将高属性线段初始化为第一个障碍物车辆L1。Step 203: Initialize the high attribute line segment as the first obstacle vehicle L1.
在本步骤中,可以假设高属性线段对应的障碍物为车辆,该障碍物车辆记为L1,并可以将线段序号加1,继续执行步骤204。In this step, it can be assumed that the obstacle corresponding to the high-attribute line segment is a vehicle, the obstacle vehicle is recorded as L1, and the line segment number is increased by 1, and the process proceeds to step 204.
步骤204、判断线段是否为高属性。Step 204: Determine whether the line segment is a high attribute.
在本步骤中,可以判断线段是否为高属性,如果是,则继续执行步骤205,否则,执行步骤205’。In this step, it can be determined whether the line segment is of a high attribute. If so, step 205 is continued, otherwise, step 205 'is performed.
步骤205、将高属性线段初始化为第二个障碍物车辆L2。Step 205: Initialize the high attribute line segment as the second obstacle vehicle L2.
在本步骤中,可以假设高属性线段对应的障碍物为车辆,该障碍物车辆记为L2,并可以继续执行步骤206,以确定L1、L2之间是否存在车位。In this step, it can be assumed that the obstacle corresponding to the high attribute line segment is a vehicle, and the obstacle vehicle is recorded as L2, and step 206 can be continued to determine whether there is a parking space between L1 and L2.
步骤205’、判断该线段是否与L1对应的线段位于车辆同一侧。Step 205 ', it is determined whether the line segment corresponding to L1 is located on the same side of the vehicle.
如果是,则继续执行步骤206’,否则,将线段序号加1,返回执行步骤202。If yes, continue to step 206 '; otherwise, increase the line segment number by 1 and return to step 202.
步骤206’、判断该线段与L1之间的横向深度距离dp是否大于车宽。Step 206 ': It is determined whether the lateral depth distance dp between the line segment and L1 is greater than the vehicle width.
如果否,则可以将线段序号加1,返回执行步骤202,如果是,则可以执行步骤207’。If not, the line segment number can be increased by 1 and the process returns to step 202. If so, step 207 'can be performed.
在本步骤中,确定该线段与L1之间的距离是否足以容纳进行车位检测的车辆。由于车宽值小于车长值,在本步骤中,可以通过横向深度距离dp与车宽的比较,优先确定横向深度距离dp是否足以容纳车宽。In this step, it is determined whether the distance between the line segment and L1 is sufficient to accommodate a vehicle for parking space detection. Since the vehicle width value is smaller than the vehicle length value, in this step, the lateral depth distance dp can be compared with the vehicle width to determine whether the lateral depth distance dp is sufficient to accommodate the vehicle width.
步骤207’、将该线段加入路沿线段集。Step 207 ': Add the line segment to the roadside line segment set.
在本步骤中,可以假设低属性线段对应的障碍物为路沿,加入路沿线段集合,并可以将线段序号加1,返回执行步骤204,继续寻找高属性线段。In this step, it can be assumed that the obstacle corresponding to the low-attribute line segment is a roadside, and the roadside line segment set is added, and the line segment number can be increased by 1, and the process returns to step 204 to continue searching for the high-attribute line segment.
步骤206、确定θ 12是否小于25度,d 12是否小于1米,L3是否大于车宽+0.6米。 Step 206: Determine whether θ 12 is less than 25 degrees, whether d 12 is less than 1 meter, and whether L3 is greater than the vehicle width + 0.6 meters.
在本步骤中,可以判断相邻两条高属性的线段之间(即L1、L2之间)的夹角θ 12、横向深度距离d 12,以及纵向长度距离L3是否满足要求。如果满足要求,则可以继续进行判断,执行步骤207,否则,可以认为L1、L2之间不存在车位,执行步骤208’。 In this step, it can be determined whether the included angle θ 12 between the two adjacent high-performance line segments (that is, between L1 and L2), the lateral depth distance d 12 , and the longitudinal length distance L3 meet the requirements. If the requirements are met, the judgment can be continued, and step 207 is performed; otherwise, it can be considered that there is no parking space between L1 and L2, and step 208 'is performed.
在本步骤中,确定L1与L2之间的距离是否足以容纳进行车位检测的车辆。由于垂直车位对L1与L2之间的纵向长度距离L3的要求较小,在本步骤中,可以优先确定L3是否满足垂直车位要求。In this step, it is determined whether the distance between L1 and L2 is sufficient to accommodate a vehicle for parking space detection. Because the vertical parking space has a smaller requirement for the longitudinal length distance L3 between L1 and L2, in this step, it can be determined first whether L3 meets the vertical parking space requirement.
步骤208’、将L2初始化为第一个障碍物车辆L1。Step 208 ': Initialize L2 as the first obstacle vehicle L1.
如果相邻两条高属性的线段之间的夹角、横向深度距离,以及纵向长度距离至少一个不满设定要求,则可以确定L1、L2之间不存在车位,可以将当前的L2初始化为L1,重新在下一个相邻两条高属性的线段之间寻找车位。并可以将线段需要加1,返回执行步骤204。If at least one of the included angle, the horizontal depth distance, and the vertical length distance between two adjacent high-performance line segments is not satisfied with the setting requirements, it can be determined that there is no parking space between L1 and L2, and the current L2 can be initialized to L1 , Re-find a parking space between the next two adjacent high-segment line segments. In addition, the line segment needs to be increased by 1 and the process returns to step 204.
步骤207、确定L3是否大于车长+0.8米。Step 207: Determine whether L3 is greater than the vehicle length +0.8 meters.
如果L3满足垂直车位要求,进一步判断L3是否满足平行车位要求。如果是,则继续执行步骤208,进一步进行平行车位判断,否则,可以执行步骤209,进一步进行垂直车位判断。If L3 meets the requirements for vertical parking spaces, further determine whether L3 meets the requirements for parallel parking spaces. If yes, proceed to step 208 to further determine the parallel parking space; otherwise, proceed to step 209 to further perform the vertical parking space judgment.
步骤208、L1、L2的长度是否均大于0.8倍车长。In step 208, whether the lengths of L1 and L2 are greater than 0.8 times the vehicle length.
如果是,则可以确定L1、L2之间至少存在一个平行车位,并可以返回执行步骤208’,继续寻找车位,否则,可以直接返回执行步骤208’。If yes, then it can be determined that there is at least one parallel parking space between L1 and L2, and it can return to step 208 'to continue to find a parking space; otherwise, it can directly return to step 208'.
步骤209、确定L1、L2之间是否存在其他线段。Step 209: Determine whether there are other line segments between L1 and L2.
如果是,则执行步骤210,否则,执行步骤211。If yes, go to step 210; otherwise, go to step 211.
步骤210、判断L1、L2之间存在的其他线段,与L1、L2中至少一条的横向深度距离dp是否大于车长。Step 210: Determine whether the lateral depth distance dp of other line segments existing between L1 and L2 and at least one of L1 and L2 is greater than the vehicle length.
如果L3不满足平行车位要求,则需要确定L1、L2之间的其他线段,与L1、L2之间的距离是否满足垂直车位的要求。如果是,则执行步骤211,否则,返回执行步骤208’。If L3 does not meet the requirements for parallel parking spaces, it is necessary to determine whether the distance between other line segments between L1 and L2 and L1 and L2 meets the requirements for vertical parking spaces. If yes, go to step 211; otherwise, go back to step 208 '.
在本实施例中,可以判断其他线段与L1之间的横向深度距离dp是否大于车长,以及其他线段与L2之间的横向深度距离dp是否大于车长,如果二者均大于车长,则可以执行步骤211,否则,可以返回执行步骤208’。In this embodiment, it can be determined whether the lateral depth distance dp between the other line segments and L1 is greater than the vehicle length, and whether the lateral depth distance dp between the other line segments and L2 is greater than the vehicle length. If both are greater than the vehicle length, then Step 211 may be performed; otherwise, step 208 ′ may be performed.
步骤211、L1、L2的长度是否均大于0.8倍车宽。Steps 211, L1, and L2 are all longer than 0.8 times the vehicle width.
如果是,则可以确定L1、L2之间至少存在一个垂直车位,并可以返回执行步骤208’,否则,可以直接返回执行步骤208’。If yes, it can be determined that there is at least one vertical parking space between L1 and L2, and it can be returned to execute step 208 ', otherwise, it can be directly returned to execute step 208'.
与实施例一、二基于同一发明构思,提供以下的装置。Based on the same inventive concept as Embodiments 1 and 2, the following devices are provided.
实施例三Example three
本发明实施例三提供一种车位检测装置,该装置的结构可以如图10所示,包括: Embodiment 3 of the present invention provides a parking space detection device. The structure of the device may be as shown in FIG. 10 and includes:
坐标确定模块11用于若确定车辆发生了移动,则针对车辆左侧和右侧,分别确定对应的超声波雷达检测到的每个障碍物上的点的坐标值;The coordinate determination module 11 is configured to determine the coordinate values of points on each obstacle detected by the corresponding ultrasonic radar for the left and right sides of the vehicle if it is determined that the vehicle has moved;
分组模块12用于分别针对车辆左侧和右侧,根据障碍物上的点到对应的超声波雷达的距离,对障碍物上的点进行分组;The grouping module 12 is used to group the points on the obstacle according to the distance from the points on the obstacle to the corresponding ultrasonic radar respectively for the left and right sides of the vehicle;
线段拟合模块13用于根据一个分组中每个障碍物上的点的坐标值,进行线段拟合;The line segment fitting module 13 is configured to perform line segment fitting according to the coordinate values of points on each obstacle in a group;
属性赋值模块14用于根据一个分组中具有二次回波的障碍物上的点的比例,确定拟合出的线段的高低属性,所述高低属性由于描述组成所述线段的障碍物上的点来源于高物体还是低物体;The attribute assignment module 14 is used to determine the height attribute of the fitted line segment according to the proportion of the points on the obstacle having the secondary echo in a group. The height attribute describes the source of the points on the obstacle constituting the line segment Whether it is high or low;
识别模块15用于分别针对车辆左侧和右侧对应的线段,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位。The identification module 15 is configured to determine whether there is a parking space between two adjacent high-attribute line segments for the corresponding line segments on the left and right sides of the vehicle through a model matching method.
所述装置还包括车位输出模块16,用于确定相邻两条高属性线段之间存在的车位所对应的轮廓描述,所述轮廓描述用于说明所述车位所在的位置,和/或者,确定所述车位所对应的所述车辆的目标位姿。The device further includes a parking space output module 16 for determining a contour description corresponding to a parking space existing between two adjacent high-attribute line segments, and the contour description is used to describe the location of the parking space, and / or The target posture of the vehicle corresponding to the parking space.
所述坐标确定模块11用于通过所述车辆的位姿,该障碍物上的点到对应的超声波雷达的距离,以及该超声波雷达在所述车辆上的安装位置确定每个障碍物上的点的坐标值。The coordinate determining module 11 is configured to determine a point on each obstacle by using a position of the vehicle, a distance from a point on the obstacle to a corresponding ultrasonic radar, and a mounting position of the ultrasonic radar on the vehicle. Coordinate value.
所述分组模块12具体用于分别针对车辆左侧和右侧,在当前检测到的障碍物上的点到对应的超声波雷达的距离,与该障碍物上的点之前相邻检测到的障碍物上的点到该超声波雷达的距离之间,差值的绝对值大于设定值时,将当前检测到的障碍物上的点之前,未被分组的障碍物上的点划分为一个分组。The grouping module 12 is specifically for the left and right sides of the vehicle, respectively, the distance from the point on the currently detected obstacle to the corresponding ultrasonic radar, and the obstacle detected adjacent to the point on the obstacle before When the absolute value of the difference between the distance from the upper point and the ultrasonic radar is greater than the set value, the points on the obstacle that are not grouped before the currently detected obstacle are divided into a group.
所述识别模块15用于通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位,包括:The identification module 15 is configured to determine whether there is a parking space between two adjacent high attribute line segments through a model matching method, including:
若相邻两条高属性线段之间还包括低属性线段,则确定该低属性线段与所述相邻两条高属性线段中至少一条之间的横向深度距离,与所述车辆的车宽之间的差值是否大于第一门限值;以及,确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车长之间的差值是否大于第二门限值;If a low attribute line segment is also included between two adjacent high attribute line segments, determine a lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and Whether the difference between them is greater than the first threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high-performance line segments and the vehicle length of the vehicle is greater than the second threshold value;
若所述横向深度距离与所述车辆的车宽之间的差值大于第一门限值,且所述纵向长度距离与所述车辆的车长之间的差值大于第二门限值,则确定相邻两条高属性线段之间,存在至少一个车位;或者,If the difference between the lateral depth distance and the vehicle width of the vehicle is greater than a first threshold value, and the difference between the longitudinal length distance and the vehicle length of the vehicle is greater than a second threshold value, Then determine that there is at least one parking space between two adjacent high attribute line segments; or
若相邻两条高属性线段之间不包括低属性线段,则确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车长之间的差值是否大于第二门限值,若是,则确定相邻两条高属性线段之间,存在至少一个车位。If a low attribute line segment is not included between two adjacent high attribute line segments, determine whether a difference between a longitudinal length distance between the adjacent two high attribute line segments and a vehicle length of the vehicle is greater than a second door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
所述识别模块15还用于确定相邻两条高属性的线段长度均大于第一指定值。The identification module 15 is further configured to determine that the lengths of two adjacent high-segment line segments are greater than a first specified value.
所述识别模块15用于通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位,包括:若相邻两条高属性线段之间还包括低属性线段,则确定该低属性线段与所述相邻两条高属性线段中至少一条之间的横向深度距离,与所述车辆的车长之间的差值是否大于第三门限值;以及确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车宽之间的差值是否大于第四门限值;The identification module 15 is configured to determine whether there is a parking space between two adjacent high-attribute line segments by using a model matching method, including: if a low-attribute line segment is also included between two adjacent high-attribution line segments, determining the low attribute Whether the difference between the lateral depth distance between the line segment and at least one of the two adjacent high attribute line segments and the vehicle length of the vehicle is greater than a third threshold; and Whether the difference between the longitudinal length distance between the line segments and the width of the vehicle is greater than a fourth threshold value;
若所述横向深度距离与所述车辆的车长之间的差值大于所述第三门限值,且所述纵向长度距离与所述车辆的车宽之间的差值大于第四门限值,则确定相邻两条高属性线段之间,存在至少一个车位;或者,If the difference between the lateral depth distance and the vehicle length of the vehicle is greater than the third threshold value, and the difference between the longitudinal length distance and the vehicle width of the vehicle is greater than a fourth threshold value Value, determine that there is at least one parking space between two adjacent high attribute line segments; or,
若相邻两条高属性线段之间不包括低属性线段,则确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车宽之间的差值是否大于第四门限值,若是,则确定相邻两条高属性线段之间,存在至少一个车位。If the low attribute line segment is not included between two adjacent high attribute line segments, determine whether the difference between the longitudinal length distance between the adjacent two high attribute line segments and the vehicle width of the vehicle is greater than the fourth door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
所述识别模块15还用于确定相邻两条高属性的线段长度均大于第二指定值。The identification module 15 is further configured to determine that the lengths of two adjacent high attribute line segments are greater than a second specified value.
所述识别模块15还用于确定相邻两条高属性的线段之间的夹角小于第一阈值,且相邻两条高属性的线段之间的横向深度距离小于第二阈值。The identification module 15 is further configured to determine that an included angle between two adjacent high-level line segments is smaller than a first threshold, and a lateral depth distance between two adjacent high-level line segments is smaller than a second threshold.
基于同一发明构思,本发明实施例提供以下的设备和介质。Based on the same inventive concept, embodiments of the present invention provide the following devices and media.
实施例四Example 4
本发明实施例四提供一种车位检测设备,该设备的结构可以如图11所示,包括存储器21、处理器22及存储在存储器上的计算机程序,所述处理器22执行所述程序时实现本发明实施例一所述方法的步骤。Embodiment 4 of the present invention provides a parking space detection device. The structure of the device may include a memory 21, a processor 22, and a computer program stored on the memory, as shown in FIG. 11, and is implemented when the processor 22 executes the program. Steps of the method according to the first embodiment of the present invention.
可选的,所述处理器22具体可以包括中央处理器(CPU)、特定应用集成电路(ASIC,application specific integrated circuit),可以是一个或多个用于控制程序执行的集成电路,可以是使用现场可编程门阵列(FPGA,field programmable gate array)开发的硬件电路,可以是基带处理器。Optionally, the processor 22 may specifically include a central processing unit (CPU), an application-specific integrated circuit (ASIC), may be one or more integrated circuits for controlling program execution, and may be used A hardware circuit developed by a field programmable gate array (FPGA, field programmable gate array) can be a baseband processor.
可选的,所述处理器22可以包括至少一个处理核心。Optionally, the processor 22 may include at least one processing core.
可选的,所述存储器21可以包括只读存储器(ROM,read only memory)、随机存取存储器(RAM,random access memory)和磁盘存储器。存储器21用于存储至少一个处理器22运行时所需的数据。存储器21的数量可以为一个或多个。Optionally, the memory 21 may include a read-only memory (ROM, read only memory), a random access memory (RAM, random access memory), and a magnetic disk memory. The memory 21 is configured to store data required when the at least one processor 22 is running. The number of the memories 21 may be one or more.
本发明实施例五提供一种非易失性计算机存储介质,所述计算机存储介质存储有可执行程序,当可执行程序被处理器执行时,实现本发明实施例一提供的方法。Embodiment 5 of the present invention provides a non-volatile computer storage medium. The computer storage medium stores an executable program. When the executable program is executed by a processor, the method provided in Embodiment 1 of the present invention is implemented.
在具体的实施过程中,计算机存储介质可以包括:通用串行总线闪存盘(USB,Universal Serial Bus flash drive)、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的存储介质。In a specific implementation process, a computer storage medium may include: a universal serial bus flash disk (USB, Universal Serial Bus flash drive), a mobile hard disk, a read-only memory (ROM, Read-Only Memory), and a random access memory (RAM , Random Access Memory), magnetic disk or compact disc and other storage media that can store program code.
在本发明实施例中,应该理解到,所揭露的设备和方法,可以通过其它的方式实现。例如,以上所描述的设备实施例仅仅是示意性的,例如,所述单元或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,设备或单元的间接耦合或通信连接,可以是电性或其它的形式。In the embodiments of the present invention, it should be understood that the disclosed device and method may be implemented in other manners. For example, the device embodiments described above are only schematic. For example, the division of the unit or unit is only a logical function division. In actual implementation, there may be another division manner. For example, multiple units or components may The combination can either be integrated into another system, or some features can be ignored or not implemented. In addition, the displayed or discussed mutual coupling or direct coupling or communication connection may be through some interfaces, the indirect coupling or communication connection of the device or unit, and may be electrical or other forms.
在本发明实施例中的各功能单元可以集成在一个处理单元中,或者各个单元也可以均是独立的物理模块。Each functional unit in the embodiment of the present invention may be integrated into one processing unit, or each unit may also be an independent physical module.
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明实施例的技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备,例如可以是个人计算机,服务器,或者网络设备等,或处理器(processor)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:通用串行总线闪存盘(universal serial bus flash drive)、移动硬盘、ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。If the integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it may be stored in a computer-readable storage medium. Based on such an understanding, all or part of the technical solutions of the embodiments of the present invention may be embodied in the form of a software product. The computer software product is stored in a storage medium and includes several instructions for making a computer device, for example, may be A personal computer, a server, or a network device, or a processor executes all or part of the steps of the method described in each embodiment of the present invention. The foregoing storage medium includes: a universal serial bus flash drive (universal serial flash drive), a mobile hard disk, a ROM, a RAM, a magnetic disk, or an optical disc, and other media that can store program codes.
本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。Those skilled in the art should understand that the embodiments of the present invention may be provided as a method, a system, or a computer program product. Therefore, the present invention may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Moreover, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
本发明是参照根据本发明实施例的方法、装置(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。The present invention is described with reference to flowcharts and / or block diagrams of methods, apparatuses (systems), and computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowcharts and / or block diagrams, and combinations of processes and / or blocks in the flowcharts and / or block diagrams can be implemented by computer program instructions. These computer program instructions may be provided to a processor of a general-purpose computer, special-purpose computer, embedded processor, or other programmable data processing device to produce a machine, so that the instructions generated by the processor of the computer or other programmable data processing device are used to generate instructions Means for implementing the functions specified in one or more flowcharts and / or one or more blocks of the block diagrams.
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to work in a specific manner such that the instructions stored in the computer-readable memory produce a manufactured article including an instruction device, the instructions The device implements the functions specified in one or more flowcharts and / or one or more blocks of the block diagram.
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。These computer program instructions can also be loaded onto a computer or other programmable data processing device, so that a series of steps can be performed on the computer or other programmable device to produce a computer-implemented process, which can be executed on the computer or other programmable device. The instructions provide steps for implementing the functions specified in one or more flowcharts and / or one or more blocks of the block diagrams.
尽管已描述了本发明的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例作出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。Although the preferred embodiments of the present invention have been described, those skilled in the art can make other changes and modifications to these embodiments once they know the basic inventive concepts. Therefore, the appended claims are intended to be construed to include the preferred embodiments and all changes and modifications that fall within the scope of the invention.
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。Obviously, those skilled in the art can make various modifications and variations to the present invention without departing from the spirit and scope of the present invention. In this way, if these modifications and variations of the present invention fall within the scope of the claims of the present invention and their equivalent technologies, the present invention also intends to include these modifications and variations.

Claims (12)

  1. 一种车位检测方法,其特征在于,车辆左右两侧的指定位置均安装有一个超声波雷达,所述方法包括:A parking space detection method, characterized in that an ultrasonic radar is installed at designated positions on the left and right sides of the vehicle, and the method includes:
    若确定所述车辆发生了移动,则针对车辆左侧和右侧,分别确定对应的超声波雷达检测到的每个障碍物上的点的坐标值;并分别针对车辆左侧和右侧,根据障碍物上的点到对应的超声波雷达的距离,对障碍物上的点进行分组;If it is determined that the vehicle has moved, the coordinate values of points on each obstacle detected by the corresponding ultrasonic radar are determined respectively for the left and right sides of the vehicle; and the left and right sides of the vehicle are respectively determined according to the obstacles. The distance from the points on the object to the corresponding ultrasonic radar to group the points on the obstacle;
    根据一个分组中每个障碍物上的点的坐标值,进行线段拟合,并根据该分组中具有二次回波的障碍物上的点的比例,确定拟合出的线段的高低属性,所述高低属性由于描述组成所述线段的障碍物上的点来源于高物体还是低物体;According to the coordinate values of the points on each obstacle in a group, line segment fitting is performed, and according to the ratio of the points on the obstacle with the secondary echo in the group, the height attribute of the fitted line segment is determined. The high and low attributes describe whether the points on the obstacles that make up the line segment originate from high or low objects;
    分别针对车辆左侧和右侧对应的线段,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位。For the line segments corresponding to the left and right sides of the vehicle, a model matching method is used to determine whether there is a parking space between two adjacent high attribute line segments.
  2. 如权利要求1所述的方法,其特征在于,所述方法还包括:The method of claim 1, further comprising:
    确定相邻两条高属性线段之间存在的车位所对应的轮廓描述,所述轮廓描述用于说明所述车位所在的位置,和/或者,确定所述车位所对应的所述车辆的目标位姿。Determining a contour description corresponding to a parking space existing between two adjacent high attribute line segments, the contour description is used to describe a position where the parking space is located, and / or determining a target position of the vehicle corresponding to the parking space posture.
  3. 如权利要求1所述的方法,其特征在于,每个障碍物上的点的坐标值通过所述车辆的位姿,该障碍物上的点到对应的超声波雷达的距离,以及该超声波雷达在所述车辆上的安装位置确定。The method of claim 1, wherein the coordinate value of a point on each obstacle passes through the pose of the vehicle, the distance from the point on the obstacle to the corresponding ultrasonic radar, and the ultrasonic radar at The installation position on the vehicle is determined.
  4. 如权利要求1所述的方法,其特征在于,分别针对车辆左侧和右侧,根据障碍物上的点到对应的超声波雷达的距离,对障碍物上的点进行分组,包括:The method according to claim 1, wherein the grouping of the points on the obstacle according to the distance from the point on the obstacle to the corresponding ultrasonic radar for each of the left and right sides of the vehicle comprises:
    分别针对车辆左侧和右侧,在当前检测到的障碍物上的点到对应的超声波雷达的距离,与该障碍物上的点之前相邻检测到的障碍物上的点到该超声波雷达的距离之间,差值的绝对值大于设定值时,将当前检测到的障碍物上的点之前,未被分组的障碍物上的点划分为一个分组。For the left and right sides of the vehicle, the distance from the point on the currently detected obstacle to the corresponding ultrasonic radar, and the point on the obstacle detected adjacent to the point before the obstacle to the ultrasonic radar. When the absolute value of the difference between the distances is greater than the set value, the points on the obstacle that are not grouped before the currently detected obstacle are divided into a group.
  5. 如权利要求1所述的方法,其特征在于,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位,包括:The method according to claim 1, wherein determining whether a parking space exists between two adjacent high attribute line segments by using a model matching method comprises:
    若相邻两条高属性线段之间还包括低属性线段,则确定该低属性线段与所述相邻两条高属性线段中至少一条之间的横向深度距离,与所述车辆的车宽之间的差值是否大于第一门限值;以及,确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车长之间的差值是否大于第二门限值;If a low attribute line segment is also included between two adjacent high attribute line segments, determine a lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and Whether the difference between them is greater than the first threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high-performance line segments and the vehicle length of the vehicle is greater than the second threshold value;
    若所述横向深度距离与所述车辆的车宽之间的差值大于第一门限值,且所述纵向长度距离与所述车辆的车长之间的差值大于第二门限值,则确定相邻两条高属性线段之间,存在至少一个车位;或者,If the difference between the lateral depth distance and the vehicle width of the vehicle is greater than a first threshold value, and the difference between the longitudinal length distance and the vehicle length of the vehicle is greater than a second threshold value, Then determine that there is at least one parking space between two adjacent high attribute line segments; or
    若相邻两条高属性线段之间不包括低属性线段,则确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车长之间的差值是否大于第二门限值,若是,则确定相邻两条高属性线段之间,存在至少一个车位。If a low attribute line segment is not included between two adjacent high attribute line segments, determine whether a difference between a longitudinal length distance between the adjacent two high attribute line segments and a vehicle length of the vehicle is greater than a second door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
  6. 如权利要求5所述的方法,其特征在于,所述方法还包括:确定相邻两条高属性的线段长度均大于第一指定值。The method according to claim 5, further comprising: determining that the lengths of two adjacent high attribute line segments are greater than a first specified value.
  7. 如权利要求1所述的方法,其特征在于,通过模型匹配方法,确定相邻两条高属性线段之间, 是否存在车位,包括:The method according to claim 1, wherein determining whether a parking space exists between two adjacent high attribute line segments through a model matching method comprises:
    若相邻两条高属性线段之间还包括低属性线段,则确定该低属性线段与所述相邻两条高属性线段中至少一条之间的横向深度距离,与所述车辆的车长之间的差值是否大于第三门限值;以及确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车宽之间的差值是否大于第四门限值;If a low attribute line segment is also included between two adjacent high attribute line segments, determine the lateral depth distance between the low attribute line segment and at least one of the two adjacent high attribute line segments, and the length of the vehicle Whether the difference between them is greater than the third threshold value; and determining whether the difference between the longitudinal length distance between two adjacent high attribute line segments and the width of the vehicle is greater than the fourth threshold value;
    若所述横向深度距离与所述车辆的车长之间的差值大于所述第三门限值,且所述纵向长度距离与所述车辆的车宽之间的差值大于第四门限值,则确定相邻两条高属性线段之间,存在至少一个车位;或者,If the difference between the lateral depth distance and the vehicle length of the vehicle is greater than the third threshold value, and the difference between the longitudinal length distance and the vehicle width of the vehicle is greater than a fourth threshold value Value, determine that there is at least one parking space between two adjacent high attribute line segments; or,
    若相邻两条高属性线段之间不包括低属性线段,则确定相邻两条高属性的线段之间的纵向长度距离,与所述车辆的车宽之间的差值是否大于第四门限值,若是,则确定相邻两条高属性线段之间,存在至少一个车位。If the low attribute line segment is not included between two adjacent high attribute line segments, determine whether the difference between the longitudinal length distance between the adjacent two high attribute line segments and the vehicle width of the vehicle is greater than the fourth door The limit value, if yes, determine that there is at least one parking space between two adjacent high attribute line segments.
  8. 如权利要求5所述的方法,其特征在于,所述方法还包括:确定相邻两条高属性的线段长度均大于第二指定值。The method according to claim 5, further comprising: determining that the lengths of two adjacent high attribute line segments are greater than a second specified value.
  9. 如权利要求5~8任一所述的方法,其特征在于,所述方法还包括:The method according to any one of claims 5 to 8, further comprising:
    确定相邻两条高属性的线段之间的夹角小于第一阈值,且相邻两条高属性的线段之间的横向深度距离小于第二阈值。It is determined that an included angle between two adjacent high-level line segments is smaller than a first threshold, and a lateral depth distance between two adjacent high-level line segments is smaller than a second threshold.
  10. 一种车位检测装置,其特征在于,所述装置包括:A parking space detection device, characterized in that the device includes:
    坐标确定模块,用于若确定车辆发生了移动,则针对车辆左侧和右侧,分别确定对应的超声波雷达检测到的每个障碍物上的点的坐标值;A coordinate determining module, configured to determine the coordinate values of points on each obstacle detected by a corresponding ultrasonic radar for the left and right sides of the vehicle if it is determined that the vehicle has moved;
    分组模块,用于分别针对车辆左侧和右侧,根据障碍物上的点到对应的超声波雷达的距离,对障碍物上的点进行分组;A grouping module is used to group the points on the obstacle according to the distance from the point on the obstacle to the corresponding ultrasonic radar respectively for the left and right sides of the vehicle;
    线段拟合模块,用于根据一个分组中每个障碍物上的点的坐标值,进行线段拟合;The line segment fitting module is used for line segment fitting according to the coordinate values of points on each obstacle in a group;
    属性赋值模块,用于根据一个分组中具有二次回波的障碍物上的点的比例,确定拟合出的线段的高低属性,所述高低属性由于描述组成所述线段的障碍物上的点来源于高物体还是低物体;An attribute assignment module is used to determine the height attribute of the fitted line segment according to the proportion of the points on the obstacle having the secondary echo in a group. The height attribute describes the source of the points on the obstacle constituting the line segment. Whether it is high or low;
    识别模块,用于分别针对车辆左侧和右侧对应的线段,通过模型匹配方法,确定相邻两条高属性线段之间,是否存在车位。A recognition module is used to determine whether there is a parking space between two adjacent high attribute line segments for the corresponding line segments on the left and right sides of the vehicle through a model matching method.
  11. 一种非易失性计算机存储介质,其特征在于,所述计算机存储介质存储有可执行程序,该可执行程序被处理器执行实现权利要求1~9任一所述方法的步骤。A non-volatile computer storage medium, characterized in that the computer storage medium stores an executable program, and the executable program is executed by a processor to implement the steps of the method according to any one of claims 1 to 9.
  12. 一种车位检测设备,其特征在于,包括存储器、处理器及存储在存储器上的计算机程序,所述处理器执行所述程序时实现权利要求1~9任一所述方法的步骤。A parking space detection device, comprising a memory, a processor, and a computer program stored on the memory. When the processor executes the program, the steps of the method according to any one of claims 1 to 9 are implemented.
PCT/CN2019/093486 2018-07-06 2019-06-28 Parking space detection method and apparatus, and medium and device WO2020007235A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201810736559.9A CN110687539B (en) 2018-07-06 2018-07-06 Parking space detection method, device, medium and equipment
CN201810736559.9 2018-07-06

Publications (1)

Publication Number Publication Date
WO2020007235A1 true WO2020007235A1 (en) 2020-01-09

Family

ID=69060737

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/093486 WO2020007235A1 (en) 2018-07-06 2019-06-28 Parking space detection method and apparatus, and medium and device

Country Status (2)

Country Link
CN (1) CN110687539B (en)
WO (1) WO2020007235A1 (en)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112485801A (en) * 2020-12-10 2021-03-12 广州小鹏自动驾驶科技有限公司 Obstacle position determination method, system, computer equipment and storage medium
CN112767512A (en) * 2020-12-31 2021-05-07 广州小鹏自动驾驶科技有限公司 Environment linear element generation method and device, electronic equipment and storage medium
CN112863242A (en) * 2021-02-08 2021-05-28 广州小鹏自动驾驶科技有限公司 Parking space detection method and device
CN112863234A (en) * 2021-01-05 2021-05-28 广州小鹏自动驾驶科技有限公司 Parking space display method and device, electronic equipment and storage medium
CN113060131A (en) * 2021-04-16 2021-07-02 中国第一汽车股份有限公司 Obstacle map generation method and device, vehicle and storage medium
CN113552575A (en) * 2021-07-16 2021-10-26 铁将军汽车电子股份有限公司 Parking obstacle detection method and device
CN113552574A (en) * 2021-07-13 2021-10-26 上海欧菲智能车联科技有限公司 Region detection method and device, storage medium and electronic equipment
US20210370929A1 (en) * 2020-06-02 2021-12-02 Hyundai Motor Company Vehicle and method of controlling the same
CN114114286A (en) * 2021-11-04 2022-03-01 广州小鹏自动驾驶科技有限公司 Ultrasonic radar control method and device for vehicle
CN115376358A (en) * 2022-07-18 2022-11-22 英博超算(南京)科技有限公司 Ultrasonic parking space detection based on finite state machine
CN115384518A (en) * 2022-10-28 2022-11-25 杭州枕石智能科技有限公司 Side parking space positioning method and device based on ultrasonic radar
US11594134B2 (en) 2020-01-21 2023-02-28 Apollo Intelligent Driving Technology (Beijing) Co., Ltd. Parking space detection method and apparatus, electronic device, vehicle and storage medium
CN112767512B (en) * 2020-12-31 2024-04-19 广州小鹏自动驾驶科技有限公司 Method and device for generating environment linear element, electronic equipment and storage medium

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111562591B (en) * 2020-05-11 2021-06-18 清华大学 Automobile position measuring method and device based on laser radar
CN113702983A (en) * 2020-05-20 2021-11-26 广州汽车集团股份有限公司 Parking space fusion identification method and system for automatic parking
CN112289070B (en) * 2020-10-20 2021-12-07 广州小鹏自动驾驶科技有限公司 Parking space detection method and device, vehicle and readable medium
CN113253278A (en) * 2021-04-28 2021-08-13 奇瑞汽车股份有限公司 Parking space identification method and device and computer storage medium
CN113311437B (en) * 2021-06-08 2022-04-19 安徽域驰智能科技有限公司 Method for improving angular point position accuracy of vehicle-mounted radar positioning side parking space
CN113581174B (en) * 2021-08-23 2023-03-24 安徽江淮汽车集团股份有限公司 Obstacle positioning method and obstacle positioning device for vehicle

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012027767A (en) * 2010-07-26 2012-02-09 Nippon Soken Inc Parking space detecting device
CN103241239A (en) * 2013-04-27 2013-08-14 重庆邮电大学 Parking space identifying method for automatic parking system
CN105035075A (en) * 2015-06-24 2015-11-11 合肥中科自动控制系统有限公司 Path planning method for autonomous parallel parking
CN105608924A (en) * 2016-02-18 2016-05-25 广州橙行智动汽车科技有限公司 Parking stall detection method based on ultrasonic radar
CN105869432A (en) * 2016-03-29 2016-08-17 江苏大学 Method for identifying parking lot scene based on multiple-sensor fusion
CN106671974A (en) * 2015-11-10 2017-05-17 新乡航空工业(集团)有限公司 Parking space detection method for intelligent parking system

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007030700A (en) * 2005-07-27 2007-02-08 Aisin Seiki Co Ltd Parking support device
CN103600707B (en) * 2013-11-06 2016-08-17 同济大学 A kind of parking position detection device and method of Intelligent parking system
KR20180047210A (en) * 2016-10-31 2018-05-10 현대자동차주식회사 Apparatus and method for detecting parking slot

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012027767A (en) * 2010-07-26 2012-02-09 Nippon Soken Inc Parking space detecting device
CN103241239A (en) * 2013-04-27 2013-08-14 重庆邮电大学 Parking space identifying method for automatic parking system
CN105035075A (en) * 2015-06-24 2015-11-11 合肥中科自动控制系统有限公司 Path planning method for autonomous parallel parking
CN106671974A (en) * 2015-11-10 2017-05-17 新乡航空工业(集团)有限公司 Parking space detection method for intelligent parking system
CN105608924A (en) * 2016-02-18 2016-05-25 广州橙行智动汽车科技有限公司 Parking stall detection method based on ultrasonic radar
CN105869432A (en) * 2016-03-29 2016-08-17 江苏大学 Method for identifying parking lot scene based on multiple-sensor fusion

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11594134B2 (en) 2020-01-21 2023-02-28 Apollo Intelligent Driving Technology (Beijing) Co., Ltd. Parking space detection method and apparatus, electronic device, vehicle and storage medium
US20210370929A1 (en) * 2020-06-02 2021-12-02 Hyundai Motor Company Vehicle and method of controlling the same
US11648941B2 (en) * 2020-06-02 2023-05-16 Hyundai Motor Company Vehicle and method of controlling the same
CN112485801A (en) * 2020-12-10 2021-03-12 广州小鹏自动驾驶科技有限公司 Obstacle position determination method, system, computer equipment and storage medium
CN112767512A (en) * 2020-12-31 2021-05-07 广州小鹏自动驾驶科技有限公司 Environment linear element generation method and device, electronic equipment and storage medium
CN112767512B (en) * 2020-12-31 2024-04-19 广州小鹏自动驾驶科技有限公司 Method and device for generating environment linear element, electronic equipment and storage medium
CN112863234A (en) * 2021-01-05 2021-05-28 广州小鹏自动驾驶科技有限公司 Parking space display method and device, electronic equipment and storage medium
CN112863242A (en) * 2021-02-08 2021-05-28 广州小鹏自动驾驶科技有限公司 Parking space detection method and device
CN113060131A (en) * 2021-04-16 2021-07-02 中国第一汽车股份有限公司 Obstacle map generation method and device, vehicle and storage medium
CN113552574A (en) * 2021-07-13 2021-10-26 上海欧菲智能车联科技有限公司 Region detection method and device, storage medium and electronic equipment
CN113552575A (en) * 2021-07-16 2021-10-26 铁将军汽车电子股份有限公司 Parking obstacle detection method and device
CN114114286A (en) * 2021-11-04 2022-03-01 广州小鹏自动驾驶科技有限公司 Ultrasonic radar control method and device for vehicle
CN115376358A (en) * 2022-07-18 2022-11-22 英博超算(南京)科技有限公司 Ultrasonic parking space detection based on finite state machine
CN115376358B (en) * 2022-07-18 2023-12-05 英博超算(南京)科技有限公司 Ultrasonic parking space detection based on finite state machine
CN115384518A (en) * 2022-10-28 2022-11-25 杭州枕石智能科技有限公司 Side parking space positioning method and device based on ultrasonic radar

Also Published As

Publication number Publication date
CN110687539A (en) 2020-01-14
CN110687539B (en) 2021-04-13

Similar Documents

Publication Publication Date Title
WO2020007235A1 (en) Parking space detection method and apparatus, and medium and device
US11221224B2 (en) Method and device for generating path of unmanned vehicle on construction section
US9298992B2 (en) Geographic feature-based localization with feature weighting
EP3229041B1 (en) Object detection using radar and vision defined image detection zone
US9563808B2 (en) Target grouping techniques for object fusion
Hata et al. Road marking detection using LIDAR reflective intensity data and its application to vehicle localization
Guo et al. A multimodal ADAS system for unmarked urban scenarios based on road context understanding
US9495602B2 (en) Image and map-based detection of vehicles at intersections
Han et al. Road boundary detection and tracking for structured and unstructured roads using a 2D lidar sensor
JP2000090243A (en) Periphery monitoring device and method therefor
JP2016148547A (en) Detection device
JP7299976B2 (en) Environmental target feature point extraction method and apparatus
CN110929655A (en) Lane line identification method in driving process, terminal device and storage medium
Shinzato et al. Road estimation with sparse 3D points from stereo data
WO2023207845A1 (en) Parking space detection method and apparatus, and electronic device and machine-readable storage medium
Kim et al. Vision-based vehicle detection and inter-vehicle distance estimation for driver alarm system
Rasmussen et al. On-vehicle and aerial texture analysis for vision-based desert road following
CN107220632B (en) Road surface image segmentation method based on normal characteristic
Cai et al. LiDAR object detection based on optimized DBSCAN algorithm
US20220171975A1 (en) Method for Determining a Semantic Free Space
CN113740874A (en) Road edge detection method, electronic equipment and vehicle
EP3522073A1 (en) Method and apparatus for detecting road surface marking
Guo et al. CADAS: A multimodal advanced driver assistance system for normal urban streets based on road context understanding
CN112744217B (en) Collision detection method, travel path recommendation device, and storage medium
Bernardi et al. High integrity lane-level occupancy estimation of road obstacles through LiDAR and HD map data fusion

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19829894

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 19829894

Country of ref document: EP

Kind code of ref document: A1