WO2020253010A1 - Method and apparatus for positioning parking entrance in parking positioning, and vehicle-mounted terminal - Google Patents

Method and apparatus for positioning parking entrance in parking positioning, and vehicle-mounted terminal Download PDF

Info

Publication number
WO2020253010A1
WO2020253010A1 PCT/CN2019/113487 CN2019113487W WO2020253010A1 WO 2020253010 A1 WO2020253010 A1 WO 2020253010A1 CN 2019113487 W CN2019113487 W CN 2019113487W WO 2020253010 A1 WO2020253010 A1 WO 2020253010A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
pose
parking lot
semantic information
image
Prior art date
Application number
PCT/CN2019/113487
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 WO2020253010A1 publication Critical patent/WO2020253010A1/en

Links

Images

Classifications

    • 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
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V10/00Arrangements for image or video recognition or understanding
    • G06V10/20Image preprocessing
    • G06V10/24Aligning, centring, orientation detection or correction of the image
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/60Type of objects
    • G06V20/62Text, e.g. of license plates, overlay texts or captions on TV images

Definitions

  • the present invention relates to the technical field of intelligent driving, in particular to a parking lot entrance positioning method, device and vehicle-mounted terminal in parking positioning.
  • Intelligent parking technology can intelligently control vehicles to enter the parking spaces of the parking lot.
  • the vehicle when the vehicle enters the parking lot, it is necessary to accurately locate the position of the vehicle in the parking lot, so as to better control the vehicle to find a suitable parking space in the parking lot and park the car.
  • the vehicle can usually be positioned based on GPS signals. However, in indoor parking lots or underground garages, GPS signals are often blocked.
  • the invention provides a parking lot entrance positioning method, device and vehicle-mounted terminal in parking positioning, so as to improve the positioning accuracy at the entrance of the parking lot.
  • the specific technical solution is as follows.
  • an embodiment of the present invention discloses a parking lot entrance positioning method in parking positioning, including:
  • the parking lot image is an image collected in the initial recognition area
  • semantic information of the parking lot image wherein the semantic information is information used to identify landmarks around the vehicle;
  • the first vehicle pose of the vehicle is determined by a pose regression model; wherein, the pose regression model is based on the initial recognition area A number of sample parking lot images collected inside and the corresponding sample initial vehicle pose and labeled vehicle pose are trained;
  • the semantic information of the parking lot image is matched with the semantic information of each location point in the preset map, and the second vehicle pose of the vehicle is determined according to the matching result.
  • the pose regression model is obtained by training in the following manner:
  • the reference vehicle pose is determined through the model parameters in the pose regression model
  • the semantic information of the parking lot image is matched with the semantic information of each location point in the preset map according to the pose of the first vehicle, and the second vehicle position of the vehicle is determined according to the matching result
  • the steps of posture include:
  • the first vehicle pose is used as the initial value of the estimated pose, and the parking lot is calculated according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image
  • the semantic information of the image is mapped to the first mapping position in the preset map
  • the value of the estimated pose is adjusted, and the execution of the value of the estimated pose and the semantic information of the parking lot image is performed in the parking lot.
  • the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  • the following methods are used to verify whether the parking lot entrance positioning is successful:
  • the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  • the step of determining residuals between multiple second vehicle poses and multiple third vehicle poses includes:
  • the Is the i-th second vehicle pose, the Is the i-th third vehicle pose, the N is the total number of the second vehicle pose or the third vehicle pose, the min is the minimum value function, and the ⁇ is the norm symbol.
  • the step of detecting the semantic information of the parking lot image includes:
  • an embodiment of the present invention discloses a parking lot entrance positioning device in parking positioning, including:
  • the judgment module is configured to obtain the initial vehicle pose determined by the positioning module when it is detected that the vehicle enters the entrance of the parking lot, and judge whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
  • the acquiring module is configured to acquire the parking lot image collected by the camera module when the position indicated by the initial vehicle pose is in the preset initialization recognition area; wherein, the parking lot image is in the initialization recognition area Captured images;
  • the detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
  • the first determining module is configured to determine the first vehicle pose of the vehicle through a pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is It is obtained by training in advance based on a plurality of sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose;
  • the second determining module is configured to match the semantic information of the parking lot image with the semantic information of each position point in the preset map according to the pose of the first vehicle, and determine the second vehicle position of the vehicle according to the matching result posture.
  • the device further includes a training module; the training module is configured to train to obtain the pose regression model using the following operations:
  • the reference vehicle pose is determined according to the model parameters through the pose regression model;
  • the second determining module is specifically configured as:
  • the first vehicle pose is used as the initial value of the estimated pose, and the parking lot is calculated according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image
  • the semantic information of the image is mapped to the first mapping position in the preset map
  • the value of the estimated pose is adjusted, and the execution returns to the parking lot image according to the value of the estimated pose and the semantic information of the parking lot image. Calculate the semantic information of the parking lot image to be mapped to the first mapping position in the preset map;
  • the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  • the device further includes a verification module; the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful:
  • the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  • the verification module determines the residuals between multiple second vehicle poses and multiple third vehicle poses, it includes:
  • the Is the i-th second vehicle pose, the Is the i-th third vehicle pose, the N is the total number of the second vehicle pose or the third vehicle pose, the min is the minimum value function, and the ⁇ is the norm symbol.
  • the detection module is specifically configured as:
  • an embodiment of the present invention discloses a vehicle-mounted terminal, including: a processor, an image acquisition device, and a positioning device; wherein the processor includes: a judgment module, an acquisition module, a detection module, a first determination module, and a second 2. Determine the module;
  • the judging module is configured to obtain the initial vehicle pose determined by the positioning device when it is detected that the vehicle enters the entrance of the parking lot, and determine whether the position indicated by the initial vehicle pose is in a preset initialization recognition area;
  • the acquiring module is configured to acquire the parking lot image collected by the image acquisition device when the position indicated by the initial vehicle pose is in the preset initial recognition area; wherein, the parking lot image is in the initial recognition area Images collected in
  • the detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
  • the first determining module is configured to determine the first vehicle pose of the vehicle through a pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is It is obtained by training in advance based on a plurality of sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose;
  • the second determining module is configured to match the semantic information of the parking lot image with the semantic information of each position point in the preset map according to the pose of the first vehicle, and determine the second vehicle position of the vehicle according to the matching result posture.
  • the processor further includes a training module; the training module is configured to train to obtain the pose regression model using the following operations:
  • the reference vehicle pose is determined through the model parameters in the pose regression model
  • the second determining module is specifically configured as:
  • the first vehicle pose is used as the initial value of the estimated pose, and the parking lot is calculated according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image
  • the semantic information of the image is mapped to the first mapping position in the preset map
  • the value of the estimated pose is adjusted, and the execution returns to the parking lot image according to the value of the estimated pose and the semantic information of the parking lot image. Calculate the semantic information of the parking lot image to be mapped to the first mapping position in the preset map;
  • the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  • the processor further includes a verification module; the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful:
  • the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  • the verification module determines the residuals between multiple second vehicle poses and multiple third vehicle poses, it includes:
  • the Is the i-th second vehicle pose, the Is the i-th third vehicle pose, the N is the total number of the second vehicle pose or the third vehicle pose, the min is the minimum value function, and the ⁇ is the norm symbol.
  • the detection module is specifically configured as:
  • the parking lot entrance locating method, device and vehicle-mounted terminal in parking locating can combine the semantic information of the parking lot image with the positioning module when the vehicle is in the preset initialization recognition area.
  • the determined initial vehicle pose is used as the input of the pose regression model, and the first vehicle pose of the vehicle is determined by the pose regression model.
  • the pose regression model is based on the sample parking lot image in the initial recognition area and the corresponding sample initial vehicle position
  • the pose and the labeled vehicle pose are trained, and the first vehicle pose determined according to the pose regression model has a higher accuracy than the initial vehicle pose; then by matching with the semantic information in the preset map, Based on the pose of the first vehicle, the positioning range is further reduced. Therefore, the embodiment of the present invention can improve the positioning accuracy at the entrance of the parking lot.
  • any product or method of the present invention does not necessarily need to achieve all the advantages described above at the same time.
  • the semantic information in the image can be used to narrow the positioning range of the vehicle, and then the semantic information and semantic map matching can be used to further reduce the vehicle In order to determine the more accurate vehicle pose at the entrance of the parking lot, as the initial pose of the vehicle.
  • FIG. 1 is a schematic flowchart of a parking lot entrance positioning method in parking positioning according to an embodiment of the present invention
  • FIG. 2 is a schematic diagram of a parking lot ground marking line and an initial recognition area provided by an embodiment of the present invention
  • Figure 3 is a schematic diagram of a ground image determined according to a parking lot image
  • Fig. 4 is a reference diagram of the driving track of the vehicle in the initial recognition area at the entrance of the parking lot in Fig. 2;
  • FIG. 5 is a schematic structural diagram of a parking lot entrance positioning device in parking positioning according to an embodiment of the present invention.
  • Fig. 6 is a schematic structural diagram of a vehicle-mounted terminal provided by an embodiment of the present invention.
  • the embodiment of the present invention discloses a parking lot entrance positioning method, device and vehicle-mounted terminal in parking positioning, which can improve the positioning accuracy at the entrance of the parking lot.
  • the embodiments of the present invention will be described in detail below.
  • FIG. 1 is a schematic flowchart of a parking lot entrance positioning method in parking positioning according to an embodiment of the present invention. This method is applied to electronic equipment.
  • the electronic device may be an ordinary computer, a server, or an intelligent terminal device, etc., or may be a vehicle-mounted terminal installed in the vehicle.
  • the parking lot can be an indoor parking lot or an underground garage.
  • the method specifically includes the following steps.
  • Step S110 When it is detected that the vehicle has entered the entrance of the parking lot, the initial vehicle pose determined by the positioning module is acquired, and it is determined whether the position indicated by the initial vehicle pose is in the preset initialization recognition area.
  • step S120 If it is, proceed to step S120; if it is not, continue to obtain the new initial vehicle pose determined by the positioning module while the vehicle is running, and execute to determine whether the position indicated by the initial vehicle pose is in the preset initialization recognition area A step of.
  • the position of the vehicle on the preset map can be determined in real time according to the data collected by the positioning module in the vehicle.
  • the location when entering the entrance of the parking lot is obtained.
  • the vehicle pose may include the coordinate position of the vehicle and the vehicle orientation information.
  • the preset map may be a high-precision map established in advance.
  • the positioning module may be a global positioning system (Global Positioning System, GPS) module or a BeiDou Navigation Satellite System (BeiDou Navigation Satellite System, BDS) module.
  • GPS Global Positioning System
  • BDS BeiDou Navigation Satellite System
  • the initial recognition area is a preset coordinate area in the preset map. In the initial recognition area, there are significant differences in the observation of any two positions or the observation of the same position from different angles. In the initial recognition area, the position of the vehicle can be accurately determined as the initial positioning position when the vehicle enters the parking lot. When entering the parking lot, real-time positioning will be performed according to the initial positioning position.
  • the initial recognition area may be a circular area with the preset location point at the entrance of the parking lot as the center and the preset distance as the radius. For example, the preset distance can be 15m or other values.
  • FIG. 2 is a schematic diagram of a parking lot ground marking line and an initial recognition area provided by an embodiment of the present invention.
  • the marking line on the ground of the parking lot and the wall of the entrance passage of the parking lot are shown (indicated by thick lines), and the initial recognition area at the entrance of the parking lot is represented by a larger circular area.
  • the positioning module can be positioned in a larger circular area.
  • the smaller circle range in Figure 2 represents the initial pose range that can normally start the positioning system.
  • the function of GPS and other signals is to determine that the vehicle has entered the initial recognition area with a radius of 15m, so as to avoid misdetection in areas with similar terrain.
  • Step S120 Acquire parking lot images collected by the camera module.
  • the parking lot image is the image collected in the initial recognition area.
  • the camera module and positioning module in the vehicle can both collect data according to a certain period.
  • the acquired parking lot image may be: the initial vehicle pose and the indicated position in the initial recognition area are collected at the appointed time.
  • the appointed time can be understood as the same time or two moments with a short time difference.
  • the parking lot image collected by the camera module may be an image containing the internal environment of the parking lot.
  • Step S130 Detect the semantic information of the parking lot image.
  • the semantic information is information used to identify landmarks around the vehicle.
  • the semantic information may include, but is not limited to, information corresponding to landmarks such as lane lines, garage lines, indicating arrows, road signs, buildings, and sidewalks on the road surface.
  • the semantic information can be the relative position information between various markers in the image.
  • the step of detecting the semantic information of the parking lot image may specifically include:
  • the parking lot image is converted to the top view coordinate system to obtain the ground image; the ground image is binarized to obtain the processed image; the semantic information of the parking lot image is determined according to the information in the processed image.
  • the ground image can be a grayscale image.
  • the Otsu method can be used to determine the pixel threshold used to distinguish the foreground and background part of the ground image, and the ground image is binarized according to the determined pixel threshold to obtain the processed foreground part image.
  • the processed image can be directly used as the semantic information, or the relative position information between the various landmarks in the processed image can be used as the semantic information.
  • Fig. 3 is a schematic diagram of a ground image determined according to a parking lot image.
  • the lines are wall lines and lane lines on the ground.
  • an image containing semantic information can be obtained.
  • the semantic information can be the relative position between various lines.
  • the image after binarization can be called a semantic observation image.
  • Step S140 Based on the semantic information of the parking lot image and the initial vehicle pose, the first vehicle pose of the vehicle is determined through the pose regression model.
  • the pose regression model is obtained by pre-training based on multiple sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose.
  • the pose regression model can associate the semantic information of the parking lot image and the initial vehicle pose with the first vehicle pose according to the trained model parameters.
  • This step may specifically include: inputting the semantic information of the parking lot image and the initial vehicle pose as input information into the pose regression model, and obtaining the first vehicle pose of the vehicle output by the pose regression model.
  • the first vehicle pose is a vehicle pose that is more accurate than the initial vehicle pose.
  • the pose regression model can perform regression on the basis of the initial vehicle pose and the feature vector extracted from the semantic information of the parking lot image to obtain the first vehicle pose.
  • the pose regression module can use a multi-stage pose regression (Cascaded Pose Regression, CPR).
  • CPR Computed Pose Regression
  • P GPS is the initial vehicle pose
  • Iseg is the semantic observation image, that is, the semantic information of the parking lot image.
  • P GPS and I seg are the input information of CPR
  • P reg is the first vehicle pose output by CPR.
  • step S110 it is determined that the vehicle enters the initial recognition area with a radius of 15m, so that the positioning pose more accurate. This step can also be understood as identifying the position of FIG. 3 in FIG. 2.
  • Step S150 According to the first vehicle pose, match the semantic information of the parking lot image with the semantic information of each location point in the preset map, and determine the second vehicle pose of the vehicle according to the matching result.
  • this step can further improve the accuracy of the vehicle pose.
  • the semantic information of the parking lot image can be matched with the semantic information of each location point in the preset map, and a more accurate second vehicle pose can be determined according to the location point that is successfully matched.
  • the second vehicle pose can be understood as the initial pose of the vehicle that is located in the initial recognition area and meets a certain accuracy requirement.
  • it can start real-time positioning of the vehicle based on the visual and semantic map in the parking lot.
  • this embodiment can use the semantic information of the parking lot image and the initial vehicle pose determined by the positioning module as the input of the pose regression model when the vehicle is in the preset initialization recognition area.
  • the pose regression model is trained based on the sample parking lot image in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose.
  • the pose regression model is determined Compared with the initial vehicle pose, the first vehicle pose has a higher accuracy; and by matching with the semantic information in the preset map, the positioning range can be further reduced on the basis of the first vehicle pose. Therefore, this embodiment can Improve the positioning accuracy at the entrance of the parking lot. That is, this embodiment can use positioning signals such as GPS to accurately provide an initial value for the positioning system in the entrance area of the parking area, so that the positioning system can be started normally.
  • This embodiment is less dependent on the position accuracy of positioning modules such as GPS. At the same time, it also has strong robustness against the situation that the signs in the parking lot are blocked. In this embodiment, the efficiency of determining the pose of the second vehicle is high, and real-time operation can be achieved on an embedded computing device with limited computing power.
  • the pose regression model can be obtained by training in the following steps 1a to 5a.
  • Step 1a Acquire multiple sample parking lot images collected in the initial recognition area, and the sample initial vehicle pose and the marked vehicle pose corresponding to each sample parking lot image.
  • the marked vehicle pose can be understood as the true value and standard value of the vehicle pose corresponding to the sample parking lot image.
  • the sample initial vehicle pose may be the vehicle pose determined by the positioning module when collecting each sample parking lot image, or it may be the vehicle pose obtained by adding preset disturbances to the marked vehicle pose.
  • the preset disturbance can be understood as a preset modification.
  • the sample initial vehicle pose can be understood as the initial value of the vehicle pose used to input the pose regression model, and the pose regression model regresses the sample parking lot image on the basis of the initial value of the vehicle pose.
  • a large number of sample parking lot images can be collected in advance through the camera module in the initial recognition area, and the sample initial vehicle pose determined by the positioning module.
  • the marked vehicle pose corresponding to the sample parking lot image can be determined by offline positioning.
  • the semantic information in the preset map and multiple virtual driving trajectories can be directly used to simulate the collection process of the camera module in the vehicle to obtain a large number of simulated images as sample parking lot images.
  • the marked vehicle pose corresponding to the simulated image can be determined directly according to the preset map.
  • Figure 4 is a reference diagram of the vehicle's trajectory when collecting sample data in the initial recognition area at the entrance of the parking lot in Figure 2, where the irregular gray lines at the entrance of the parking lot represent the trajectory of the vehicle.
  • Step 2a Detect the sample semantic information of each sample parking lot image.
  • step S130 For a specific description of this step, refer to the description part of step S130.
  • Step 3a Based on the semantic information of each sample and the corresponding sample initial vehicle pose, the reference vehicle pose is determined through the model parameters in the pose regression model.
  • the model parameters that have been trained in other aspects in the multi-level pose regressor can be directly used as the initial values of the model parameters in this step.
  • the model parameters are constantly revised to gradually approach the true value.
  • Step 4a Determine the amount of difference between the reference vehicle pose and the marked vehicle pose.
  • the residual function may be used to determine the amount of difference between the reference vehicle pose and the marked vehicle pose.
  • Step 5a When the above difference amount is greater than the preset difference amount threshold, correct the model parameters and return to step 3a. When the difference amount is not greater than the preset difference amount threshold, it is determined that the pose regression model training is completed.
  • the preset difference threshold is a value set in advance based on experience.
  • the difference amount is greater than the preset difference amount threshold, it is considered that the model needs to be continuously trained.
  • the model parameters can be modified according to the difference. For example, the model parameters can be corrected based on the difference amount and the change trend obtained from the difference amount in the previous training process.
  • this embodiment provides a specific implementation manner for training the pose regression model, which can improve the accuracy of the pose regression model, thereby improving the accuracy of positioning.
  • step S150 according to the first vehicle pose, the semantic information of the parking lot image is matched with the semantic information of each location point in the preset map, and according to the matching result
  • the step of determining the second vehicle pose of the vehicle may include the following embodiments.
  • the first embodiment includes the following steps 1b to 5b.
  • Step 1b Match the semantic information of the parking lot image with the semantic information of each location point in the preset map, and obtain the target location of the successfully matched semantic information in the preset map.
  • Step 2b Use the first vehicle pose as the initial value of the estimated pose, and calculate the semantic information mapping of the parking lot image to the prediction based on the estimated pose value and the position of the semantic information of the parking lot image in the parking lot image. Set the first mapping position in the map.
  • mapping the semantic information of the parking lot image to the first mapping position in the preset map can be understood as mapping the semantic information of the parking lot image to the coordinate system where the preset map is located, and the mapped position is the first A mapping location.
  • Step 3b Determine the first error between the first mapping position and the target position.
  • Step 4b When the first error is greater than the preset error threshold, adjust the value of the estimated pose, and return to perform step 2b according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image, The step of calculating the semantic information of the parking lot image to be mapped to the first mapping position in the preset map.
  • Step 5b When the first error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  • this step when determining the second vehicle pose of the vehicle according to the current value of the estimated pose, it may specifically include directly determining the current value of the estimated pose as the second vehicle pose of the vehicle; it may also include, judging Whether the difference between the current value of the estimated pose and the first vehicle pose is less than a preset threshold, if it is smaller, the current value of the estimated pose is directly determined as the second vehicle pose of the vehicle.
  • the first error when the first error is greater than the preset error threshold, it is considered that the positioning accuracy has not yet reached the requirement, and iterating needs to be continued.
  • the first error is not greater than the preset error threshold, it is considered that the positioning accuracy has reached the requirement, and the iteration can be stopped to obtain the precise positioning pose of the vehicle.
  • the second embodiment includes the following steps 1c to 5c.
  • Step 1c match the semantic information of the parking lot image with the semantic information of each location point in the preset map, and obtain the target location of the successfully matched semantic information in the preset map.
  • Step 2c Use the first vehicle pose as the initial value of the estimated pose, and calculate the second mapping position in the parking lot image of the successfully matched semantic information in the preset map according to the estimated pose value and the target position.
  • calculating the second mapping position of the successfully matched semantic information in the preset map in the parking lot image can be understood as mapping the successfully matched semantic information in the preset map to the coordinate system where the parking lot image is located, and the mapping obtained The location is the second mapping location.
  • Step 3c Determine the second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image.
  • Step 4c When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to perform step 2c according to the value of the estimated pose and the target position to calculate the semantic information of the preset map matching successfully. Step of second mapping position in parking lot image.
  • Step 5c When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  • P i is the posture of the vehicle information at time i
  • a j is the preset target position map the j-th semantic information
  • X ij is a j-th semantic information and semantic information matches the location in the parking lot image
  • F(.) is the projection equation, used to project the j-th semantic information to the image imaging plane according to A j and P i , and the projection result is in the same coordinate system as X ij .
  • the semantic information in the preset map is mapped to the parking lot image, or the semantic information in the parking lot image is mapped to the preset map through two mapping methods.
  • the difference between the positions of the mapping information is calculated, and the value of the estimated pose is continuously adjusted according to the difference.
  • the second vehicle pose of the vehicle is determined according to the estimated pose. In this way, the vehicle pose can be iterated relatively quickly, and a certain positioning accuracy can be guaranteed.
  • the electronic device when the vehicle enters the initial recognition area to leave, can perform multiple initial positioning based on multiple image frames. For example, the electronic device can perform multiple initial positioning based on a preset initial positioning frequency. Perform the initial positioning shown in Figure 1 in the initial recognition area. Among them, the 5 steps in Figure 1 constitute an initial positioning. In this embodiment, after determining the second vehicle pose of the vehicle, the following steps 1d to 4d can be used to verify whether the parking lot entrance location is successful.
  • Step 1d Acquire the second vehicle poses of the vehicles corresponding to the multiple parking lot image frames when the positions indicated by the multiple initial vehicle poses determined by the positioning module are in the initialization recognition area.
  • a plurality of second vehicle poses may be determined using the five steps in FIG. 1, and each second vehicle pose may be stored in a preset storage space.
  • each second vehicle pose may be stored in a preset storage space.
  • it may be acquired from a preset storage space.
  • Step 2d Obtain multiple third vehicle poses determined according to the odometer information collected by the odometer.
  • the odometer in the vehicle can periodically collect odometer information, and based on the previous odometer information and the odometer information, the vehicle pose can be estimated as the third vehicle pose.
  • the multiple third vehicle poses determined according to the odometer information may be the pose information in the preset odometer map.
  • the frequency of determining the second vehicle pose and determining the third vehicle pose may be the same, and when the vehicle travels to a certain position, the second vehicle pose and the third vehicle pose are determined simultaneously Operation. That is, the second vehicle pose and the third vehicle pose may have a one-to-one correspondence.
  • Step 3d Determine residuals between multiple second vehicle poses and multiple third vehicle poses.
  • This step may specifically include: determining a residual error between the second vehicle pose and the third vehicle pose in a one-to-one correspondence.
  • the determined residual may be the sum of the residuals between each second vehicle pose and the corresponding third vehicle pose, or it may be the sum of the residuals between each second vehicle pose and the corresponding third vehicle pose.
  • the residual vector composed of the residuals between.
  • Step 4d When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and multiple second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  • the preset residual threshold may be a value determined in advance based on experience. When the residual is not less than the preset residual threshold, it is considered that the vehicle has failed to locate at the entrance of the parking lot.
  • this embodiment adopts in the initialization recognition area to cross-validate the vehicle pose of multiple parking lot image frames and the vehicle pose of the odometer, which can effectively reduce the false detection rate of positioning initialization.
  • the cross-validation it is determined that the initial positioning process of the entrance of the parking lot is successful, which can more accurately verify whether the accuracy of the initial positioning meets the requirements and improve the positioning accuracy.
  • step 3d the step of determining the residuals between the multiple second vehicle poses and the multiple third vehicle poses may specifically include:
  • Is the i-th second vehicle pose Is the i-th third vehicle pose
  • N is the total number of the second vehicle pose or the third vehicle pose
  • min is the minimum function
  • is the norm symbol.
  • the second vehicle pose determined from multiple parking lot image frames can adopt the first trajectory
  • the first trajectory Indicates that multiple third vehicle poses determined according to the odometer information can adopt the second trajectory Said.
  • Solve The formula can be understood as determining the minimum amount of change when changing the first trajectory to the second trajectory. Calculate the residual size of each item in trace init and trace odom , that is, calculate The matching degree of the two trajectories can be obtained, and when the matching degree is greater than the preset matching degree threshold, it is determined that the initial positioning is successful.
  • FIG. 5 is a schematic structural diagram of a parking lot entrance positioning device in parking positioning according to an embodiment of the present invention.
  • the device is applied to electronic equipment.
  • the electronic device may be an ordinary computer, a server, or an intelligent terminal device, etc., or may be a vehicle-mounted terminal installed in the vehicle.
  • This device embodiment corresponds to the method embodiment shown in FIG. 1.
  • the device includes the following modules.
  • the judging module 510 is configured to obtain the initial vehicle pose determined by the positioning module when it is detected that the vehicle has entered the entrance of the parking lot, and judge whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
  • the acquiring module 520 is configured to acquire the parking lot image collected by the camera module when the position indicated by the initial vehicle pose is in the preset initial recognition area; wherein the parking lot image is an image acquired in the initial recognition area;
  • the detection module 530 is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
  • the first determining module 540 is configured to determine the first vehicle pose of the vehicle through the pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is based on the initial recognition area
  • the collected multiple sample parking lot images and the corresponding sample initial vehicle pose and the marked vehicle pose are trained;
  • the second determining module 550 is configured to match the semantic information of the parking lot image with the semantic information of each location point in the preset map according to the first vehicle pose, and determine the second vehicle pose of the vehicle according to the matching result.
  • the device may further include a training module (not shown in the figure); the training module is configured to train the pose regression model by using the following operations:
  • the reference vehicle pose is determined through the model parameters in the pose regression model
  • modify the model parameters return to execute the operation of determining the reference vehicle pose based on the semantic information of each sample and the corresponding sample initial vehicle pose, and determine the reference vehicle pose based on the model parameters in the pose regression model;
  • the second determining module 550 is specifically configured to:
  • the semantic information of the parking lot image is mapped to The first mapping position in the preset map
  • the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  • the device may further include a verification module (not shown in the figure); the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful :
  • the residual is less than the preset residual threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and multiple second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  • the verification module when determining the residuals between the multiple second vehicle poses and the multiple third vehicle poses, includes:
  • Is the i-th second vehicle pose Is the i-th third vehicle pose
  • N is the total number of the second vehicle pose or the third vehicle pose
  • min is the minimum function
  • is the norm symbol.
  • the detection module 530 is specifically configured to:
  • the semantic information of the parking lot image is determined.
  • the foregoing device embodiment corresponds to the method embodiment, and has the same technical effect as the method embodiment.
  • the device embodiment is obtained based on the method embodiment, and the specific description can be found in the method embodiment part, which will not be repeated here.
  • Fig. 6 is a schematic structural diagram of a vehicle-mounted terminal provided by an embodiment of the present invention.
  • the vehicle-mounted terminal includes a processor 610, an image acquisition device 620, and a positioning device 630.
  • the processor includes: a judgment module, an acquisition module, a detection module, a first determination module, and a second determination module (not shown in the figure).
  • the judging module is configured to obtain the initial vehicle pose determined by the positioning device 630 when it is detected that the vehicle has entered the entrance of the parking lot, and determine whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
  • the acquiring module is configured to acquire the parking lot image collected by the image acquisition device 620 when the position indicated by the initial vehicle pose is in the preset initial recognition area; wherein, the parking lot image is an image acquired in the initial recognition area;
  • the detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
  • the first determination module is configured to determine the first vehicle pose of the vehicle through the pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is based on pre-collecting in the initialization recognition area Multiple sample parking lot images and corresponding sample initial vehicle poses and labeled vehicle poses are trained;
  • the second determining module is configured to match the semantic information of the parking lot image with the semantic information of each location point in the preset map according to the first vehicle pose, and determine the second vehicle pose of the vehicle according to the matching result.
  • the processor 610 further includes a training module (not shown in the figure); the training module is configured to use the following operations to train to obtain the pose regression model:
  • the reference vehicle pose is determined through the model parameters in the pose regression model
  • modify the model parameters return to execute the operation of determining the reference vehicle pose based on the semantic information of each sample and the corresponding sample initial vehicle pose, and determine the reference vehicle pose based on the model parameters in the pose regression model;
  • the second determining module is specifically configured as:
  • the semantic information of the parking lot image is mapped to The first mapping position in the preset map
  • the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  • the processor 610 may also include a verification module (not shown in the figure); the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful :
  • the residual is less than the preset residual threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and multiple second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  • the verification module determines the residuals between the multiple second vehicle poses and the multiple third vehicle poses, it includes:
  • Is the i-th second vehicle pose Is the i-th third vehicle pose
  • N is the total number of the second vehicle pose or the third vehicle pose
  • min is the minimum function
  • is the norm symbol.
  • the detection module is specifically configured as:
  • the semantic information of the parking lot image is determined.
  • This embodiment of the terminal and the embodiment of the method shown in FIG. 1 are embodiments based on the same inventive concept, and relevant points may be referred to each other.
  • the foregoing terminal embodiment corresponds to the method embodiment, and has the same technical effect as the method embodiment. For specific description, refer to the method embodiment.
  • modules in the device in the embodiment may be distributed in the device in the embodiment according to the description of the embodiment, or may be located in one or more devices different from this embodiment with corresponding changes.
  • the modules of the above-mentioned embodiments can be combined into one module or further divided into multiple sub-modules.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Image Analysis (AREA)
  • Traffic Control Systems (AREA)

Abstract

A method and apparatus for positioning a parking entrance in parking positioning, and a vehicle-mounted terminal. The method comprises: when it is detected that a vehicle enters an entrance of a parking lot, and it is determined that the location indicated by an initial vehicle posture of a positioning module is within a preset initialized identification region, obtaining a parking lot image collected by a camera module (S120); detecting semantic information of the parking lot image (S130); determining a first vehicle posture of the vehicle by means of a posture regression model based on the semantic information of the parking lot image and the initial vehicle posture (S140); and matching the semantic information of the parking lot image with semantic information of each location point in a preset map according to the first vehicle posture, and determining a second vehicle posture of the vehicle according to the matching result (S150), wherein the posture regression model is obtained by training according to a plurality of sample parking lot images collected in the initialized identification region in advance. The method can improve the positioning accuracy at the entrance of the parking lot.

Description

一种泊车定位中的停车场入口定位方法、装置及车载终端Parking lot entrance positioning method, device and vehicle-mounted terminal in parking positioning 技术领域Technical field
本发明涉及智能驾驶技术领域,具体而言,涉及一种泊车定位中的停车场入口定位方法、装置及车载终端。The present invention relates to the technical field of intelligent driving, in particular to a parking lot entrance positioning method, device and vehicle-mounted terminal in parking positioning.
背景技术Background technique
智能泊车技术能够智能化地控制车辆驶入停车场的停车位中。其中,当车辆驶入停车场后需要精确地定位车辆在停车场中的位置,以便更好地控制车辆在停车场中找到合适的停车位,并泊车入位。在相关技术中,通常可以根据GPS信号对车辆进行定位。但是,在室内停车场或者地下车库内部,GPS信号往往会受到阻塞。Intelligent parking technology can intelligently control vehicles to enter the parking spaces of the parking lot. Among them, when the vehicle enters the parking lot, it is necessary to accurately locate the position of the vehicle in the parking lot, so as to better control the vehicle to find a suitable parking space in the parking lot and park the car. In related technologies, the vehicle can usually be positioned based on GPS signals. However, in indoor parking lots or underground garages, GPS signals are often blocked.
在这种情况下,可以根据视觉图像中的语义信息与地图中语义信息的匹配,进行精确定位。但是,这种定位方式需要以较为精确的初始位姿作为输入才能启动。现有技术中,通常利用停车场入口处的GPS信号确定车辆在停车场的初始位姿。但是,GPS信号的定位精度不够高,导致确定的停车场入口处的初始位姿精度不够高,进而导致后续的在停车场内部的定位精度较差。In this case, precise positioning can be performed based on the match between the semantic information in the visual image and the semantic information in the map. However, this positioning method requires a more accurate initial pose as input to start. In the prior art, GPS signals at the entrance of the parking lot are usually used to determine the initial pose of the vehicle in the parking lot. However, the positioning accuracy of the GPS signal is not high enough, which results in the determined initial pose accuracy at the entrance of the parking lot is not high enough, which in turn leads to poor positioning accuracy inside the parking lot.
发明内容Summary of the invention
本发明提供了一种泊车定位中的停车场入口定位方法、装置及车载终端,以提高在停车场入口处的定位精度。具体的技术方案如下。The invention provides a parking lot entrance positioning method, device and vehicle-mounted terminal in parking positioning, so as to improve the positioning accuracy at the entrance of the parking lot. The specific technical solution is as follows.
第一方面,本发明实施例公开了一种泊车定位中的停车场入口定位方法,包括:In the first aspect, an embodiment of the present invention discloses a parking lot entrance positioning method in parking positioning, including:
当检测到车辆驶入停车场入口处时,获取定位模块确定的初始车辆位姿,判断所述初始车辆位姿指示的位置是否处于预设的初始化识别区域中;When it is detected that the vehicle has entered the entrance of the parking lot, acquiring the initial vehicle pose determined by the positioning module, and determining whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
如果处于,则获取相机模块采集的停车场图像;其中,所述停车场图像为在所述初始化识别区域中采集的图像;If it is, acquire a parking lot image collected by the camera module; wherein the parking lot image is an image collected in the initial recognition area;
检测所述停车场图像的语义信息;其中,所述语义信息为用于标识车辆周围的标志物的信息;Detecting semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
基于所述停车场图像的语义信息和所述初始车辆位姿,通过位姿回归模型确定所述车辆的第一车辆位姿;其中,所述位姿回归模型为预先根据在所述初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;Based on the semantic information of the parking lot image and the initial vehicle pose, the first vehicle pose of the vehicle is determined by a pose regression model; wherein, the pose regression model is based on the initial recognition area A number of sample parking lot images collected inside and the corresponding sample initial vehicle pose and labeled vehicle pose are trained;
根据所述第一车辆位姿,匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿。According to the first vehicle pose, the semantic information of the parking lot image is matched with the semantic information of each location point in the preset map, and the second vehicle pose of the vehicle is determined according to the matching result.
可选的,所述位姿回归模型采用以下方式训练得到:Optionally, the pose regression model is obtained by training in the following manner:
获取在所述初始化识别区域内采集的多个样本停车场图像,以及每个样本停车场图像对应的样本初始车辆位姿和标注的车辆位姿;Acquiring a plurality of sample parking lot images collected in the initial recognition area, and a sample initial vehicle pose and a marked vehicle pose corresponding to each sample parking lot image;
检测每个样本停车场图像的样本语义信息;Detect the sample semantic information of each sample parking lot image;
基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿;Based on the semantic information of each sample and the corresponding initial vehicle pose, the reference vehicle pose is determined through the model parameters in the pose regression model;
确定所述参考车辆位姿与所述标注的车辆位姿之间的差异量;Determining the amount of difference between the reference vehicle pose and the marked vehicle pose;
当所述差异量大于预设差异量阈值时,修正所述模型参数,返回执行所述基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿的步骤;When the difference amount is greater than the preset difference amount threshold, modify the model parameters, return to execute the initial vehicle pose based on the semantic information of each sample and the corresponding sample, and determine the reference vehicle based on the model parameters in the pose regression model Posture steps
当所述差异量不大于所述预设差异量阈值时,确定所述位姿回归模型训练完成。When the difference amount is not greater than the preset difference amount threshold, it is determined that the training of the pose regression model is completed.
可选的,所述根据所述第一车辆位姿,匹配所述停车场图像的语义信息与所述预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿的步骤,包括:Optionally, the semantic information of the parking lot image is matched with the semantic information of each location point in the preset map according to the pose of the first vehicle, and the second vehicle position of the vehicle is determined according to the matching result The steps of posture include:
匹配所述停车场图像的语义信息与所述预设地图中各个位置点的语义信息,得到匹配成功的语义信息在所述预设地图中对应的目标位置;Matching the semantic information of the parking lot image with the semantic information of each location point in the preset map to obtain the target location corresponding to the successfully matched semantic information in the preset map;
采用以下迭代方式中的一种确定所述车辆的第二车辆位姿;Use one of the following iterative methods to determine the second vehicle pose of the vehicle;
以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;The first vehicle pose is used as the initial value of the estimated pose, and the parking lot is calculated according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image The semantic information of the image is mapped to the first mapping position in the preset map;
确定所述第一映射位置与所述目标位置之间的第一误差;Determining a first error between the first mapping position and the target position;
当所述第一误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行所述根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置的步骤;When the first error is greater than a preset error threshold, the value of the estimated pose is adjusted, and the execution of the value of the estimated pose and the semantic information of the parking lot image is performed in the parking lot. The position in the field image, the step of calculating the semantic information of the parking lot image to be mapped to the first mapping position in the preset map;
当所述第一误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿;When the first error is not greater than the preset error threshold, determine the second vehicle pose of the vehicle according to the current value of the estimated pose;
或者,or,
以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置;Taking the first vehicle pose as the initial value of the estimated pose, and according to the value of the estimated pose and the target position, calculate the semantic information that is successfully matched in the preset map in the parking lot image The second mapping position in;
确定所述第二映射位置与所述停车场图像的语义信息在所述停车场图像中的位置之间的第二误差;Determining a second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image;
当所述第二误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行所述根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置的步骤;When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation of the preset map based on the value of the estimated pose and the target position The step of matching the second mapping position of the successfully matched semantic information in the parking lot image;
当所述第二误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿。When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
可选的,在确定所述车辆的第二车辆位姿之后,采用以下方式验证停车场入口定位是否成功:Optionally, after determining the second vehicle pose of the vehicle, the following methods are used to verify whether the parking lot entrance positioning is successful:
获取当所述定位模块确定的多个初始车辆位姿指示的位置处于所述初始化识别区域时,多个停车场图像帧对应的所述车辆的第二车辆位姿;Acquiring the second vehicle pose of the vehicle corresponding to the multiple parking lot image frames when the positions indicated by the multiple initial vehicle poses determined by the positioning module are in the initialization recognition area;
获取根据里程计采集的里程计信息确定的多个第三车辆位姿;Acquire multiple third vehicle poses determined according to the odometer information collected by the odometer;
确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
当所述残差小于预设残差阈值时,确定所述车辆在停车场入口定位成功,以所述多个第二车辆位姿作为所述车辆在停车场入口的成功定位信息。When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
可选的,所述确定多个第二车辆位姿和多个第三车辆位姿之间的残差的步骤,包括:Optionally, the step of determining residuals between multiple second vehicle poses and multiple third vehicle poses includes:
通过最小二乘法求解以下函数,得到多个第二车辆位姿和多个第三车辆位姿之间的刚性变换矩阵T:Solve the following function by the least square method to obtain the rigid transformation matrix T between multiple second vehicle poses and multiple third vehicle poses:
Figure PCTCN2019113487-appb-000001
Figure PCTCN2019113487-appb-000001
将求解得到的所述T代入
Figure PCTCN2019113487-appb-000002
得到多个第二车辆位姿和多个第三车辆位姿之间残差;
Substitute the T obtained by the solution into
Figure PCTCN2019113487-appb-000002
Obtain residuals between multiple second vehicle poses and multiple third vehicle poses;
其中,所述
Figure PCTCN2019113487-appb-000003
为第i个第二车辆位姿,所述
Figure PCTCN2019113487-appb-000004
为第i个第三车辆位姿,所述N为所述第二车辆位姿或第三车辆位姿的总数量,所述min为求最小值函数,所述‖·‖为范数符号。
Among them, the
Figure PCTCN2019113487-appb-000003
Is the i-th second vehicle pose, the
Figure PCTCN2019113487-appb-000004
Is the i-th third vehicle pose, the N is the total number of the second vehicle pose or the third vehicle pose, the min is the minimum value function, and the ‖·‖ is the norm symbol.
可选的,所述检测所述停车场图像的语义信息的步骤,包括:Optionally, the step of detecting the semantic information of the parking lot image includes:
将所述停车场图像转换至俯视图坐标系下,得到地面图像;Convert the parking lot image to the top view coordinate system to obtain a ground image;
对所述地面图像进行二值化处理,得到处理后图像;Binarize the ground image to obtain a processed image;
根据所述处理后图像中的信息,确定所述停车场图像的语义信息。Determine the semantic information of the parking lot image according to the information in the processed image.
第二方面,本发明实施例公开了一种泊车定位中的停车场入口定位装置,包括:In a second aspect, an embodiment of the present invention discloses a parking lot entrance positioning device in parking positioning, including:
判断模块,被配置为当检测到车辆驶入停车场入口处时,获取定位模块确定的初始车辆位姿,判断所述初始车辆位姿指示的位置是否处于预设的初始化识别区域中;The judgment module is configured to obtain the initial vehicle pose determined by the positioning module when it is detected that the vehicle enters the entrance of the parking lot, and judge whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
获取模块,被配置为当所述初始车辆位姿指示的位置处于预设的初始化识别区域中时,获取相机模块采集的停车场图像;其中,所述停车场图像为在所述初始化识别区域中采集的图像;The acquiring module is configured to acquire the parking lot image collected by the camera module when the position indicated by the initial vehicle pose is in the preset initialization recognition area; wherein, the parking lot image is in the initialization recognition area Captured images;
检测模块,被配置为检测所述停车场图像的语义信息;其中,所述语义信息为用于标识车辆周围的标志物的信息;The detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
第一确定模块,被配置为基于所述停车场图像的语义信息和所述初始车辆位姿,通过位姿回归模型确定所述车辆的第一车辆位姿;其中,所述位姿回归模型为预先根据在所述初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;The first determining module is configured to determine the first vehicle pose of the vehicle through a pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is It is obtained by training in advance based on a plurality of sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose;
第二确定模块,被配置为根据所述第一车辆位姿,匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿。The second determining module is configured to match the semantic information of the parking lot image with the semantic information of each position point in the preset map according to the pose of the first vehicle, and determine the second vehicle position of the vehicle according to the matching result posture.
可选的,所述装置还包括训练模块;所述训练模块,被配置为采用以下操作训练得到所述位姿回归模型:Optionally, the device further includes a training module; the training module is configured to train to obtain the pose regression model using the following operations:
获取在所述初始化识别区域内采集的多个样本停车场图像,以及每个样本停车场图像对应的样本初始车辆位姿和标注的车辆位姿;Acquiring a plurality of sample parking lot images collected in the initial recognition area, and a sample initial vehicle pose and a marked vehicle pose corresponding to each sample parking lot image;
检测每个样本停车场图像的样本语义信息;Detect the sample semantic information of each sample parking lot image;
基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型根据模型参数确定参考车辆位姿;Based on the semantic information of each sample and the corresponding sample initial vehicle pose, the reference vehicle pose is determined according to the model parameters through the pose regression model;
确定所述参考车辆位姿与所述标注的车辆位姿之间的差异量;Determining the amount of difference between the reference vehicle pose and the marked vehicle pose;
当所述差异量大于预设差异量阈值时,修正所述模型参数,返回执行所述基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型根据模型参数确定参考车辆位姿的操作;When the difference amount is greater than the preset difference amount threshold, modify the model parameters, return to execute the initial vehicle pose based on the semantic information of each sample and the corresponding sample, and determine the reference vehicle position based on the model parameters through the pose regression model Posture operation
当所述差异量不大于所述预设差异量阈值时,确定所述位姿回归模型训练完成。When the difference amount is not greater than the preset difference amount threshold, it is determined that the training of the pose regression model is completed.
可选的,所述第二确定模块,具体被配置为:Optionally, the second determining module is specifically configured as:
匹配所述停车场图像的语义信息与所述预设地图中各个位置点的语义信息,得到匹配成功的语义信息在所述预设地图中对应的目标位置;Matching the semantic information of the parking lot image with the semantic information of each location point in the preset map to obtain the target location corresponding to the successfully matched semantic information in the preset map;
采用以下迭代操作中的一种确定所述车辆的第二车辆位姿;Use one of the following iterative operations to determine the second vehicle pose of the vehicle;
以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;The first vehicle pose is used as the initial value of the estimated pose, and the parking lot is calculated according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image The semantic information of the image is mapped to the first mapping position in the preset map;
确定所述第一映射位置与所述目标位置之间的第一误差;Determining a first error between the first mapping position and the target position;
当所述第一误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;When the first error is greater than the preset error threshold, the value of the estimated pose is adjusted, and the execution returns to the parking lot image according to the value of the estimated pose and the semantic information of the parking lot image. Calculate the semantic information of the parking lot image to be mapped to the first mapping position in the preset map;
当所述第一误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿;When the first error is not greater than the preset error threshold, determine the second vehicle pose of the vehicle according to the current value of the estimated pose;
或者,or,
以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置;Taking the first vehicle pose as the initial value of the estimated pose, and according to the value of the estimated pose and the target position, calculate the semantic information that is successfully matched in the preset map in the parking lot image The second mapping position in;
确定所述第二映射位置与所述停车场图像的语义信息在所述停车场图像中的位置之间的第二误差;Determining a second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image;
当所述第二误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射 位置;When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation based on the value of the estimated pose and the target position to calculate the matching success in the preset map The second mapping position of the semantic information of in the parking lot image;
当所述第二误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿。When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
可选的,所述装置还包括验证模块;所述验证模块,被配置为采用以下操作验证停车场入口定位是否成功:Optionally, the device further includes a verification module; the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful:
在确定所述车辆的第二车辆位姿之后,获取当所述定位模块确定的多个初始车辆位姿指示的位置处于所述初始化识别区域时,多个停车场图像帧对应的所述车辆的第二车辆位姿;After determining the second vehicle pose of the vehicle, obtain the position of the vehicle corresponding to the multiple parking lot image frames when the position indicated by the multiple initial vehicle poses determined by the positioning module is in the initialization recognition area The second vehicle pose;
获取根据里程计采集的里程计信息确定的多个第三车辆位姿;Acquire multiple third vehicle poses determined according to the odometer information collected by the odometer;
确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
当所述残差小于预设残差阈值时,确定所述车辆在停车场入口定位成功,以所述多个第二车辆位姿作为所述车辆在停车场入口的成功定位信息。When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
可选的,所述验证模块,确定多个第二车辆位姿和多个第三车辆位姿之间的残差时,包括:Optionally, when the verification module determines the residuals between multiple second vehicle poses and multiple third vehicle poses, it includes:
通过最小二乘法求解以下函数,得到多个第二车辆位姿和多个第三车辆位姿之间的刚性变换矩阵T:Solve the following function by the least square method to obtain the rigid transformation matrix T between multiple second vehicle poses and multiple third vehicle poses:
Figure PCTCN2019113487-appb-000005
Figure PCTCN2019113487-appb-000005
将求解得到的所述T代入
Figure PCTCN2019113487-appb-000006
得到多个第二车辆位姿和多个第三车辆位姿之间残差;
Substitute the T obtained by the solution into
Figure PCTCN2019113487-appb-000006
Obtain residuals between multiple second vehicle poses and multiple third vehicle poses;
其中,所述
Figure PCTCN2019113487-appb-000007
为第i个第二车辆位姿,所述
Figure PCTCN2019113487-appb-000008
为第i个第三车辆位姿,所述N为所述第二车辆位姿或第三车辆位姿的总数量,所述min为求最小值函数,所述‖·‖为范数符号。
Among them, the
Figure PCTCN2019113487-appb-000007
Is the i-th second vehicle pose, the
Figure PCTCN2019113487-appb-000008
Is the i-th third vehicle pose, the N is the total number of the second vehicle pose or the third vehicle pose, the min is the minimum value function, and the ‖·‖ is the norm symbol.
可选的,所述检测模块,具体被配置为:Optionally, the detection module is specifically configured as:
将所述停车场图像转换至俯视图坐标系下,得到地面图像;Convert the parking lot image to the top view coordinate system to obtain a ground image;
对所述地面图像进行二值化处理,得到处理后图像;Binarize the ground image to obtain a processed image;
根据所述处理后图像中的信息,确定所述停车场图像的语义信息。Determine the semantic information of the parking lot image according to the information in the processed image.
第三方面,本发明实施例公开了一种车载终端,包括:处理器、图像采集设备和定位设备;其中,所述处理器包括:判断模块、获取模块、检测模块、第一确定模块和第二确定模块;In the third aspect, an embodiment of the present invention discloses a vehicle-mounted terminal, including: a processor, an image acquisition device, and a positioning device; wherein the processor includes: a judgment module, an acquisition module, a detection module, a first determination module, and a second 2. Determine the module;
判断模块,被配置为当检测到车辆驶入停车场入口处时,获取定位设备确定的初始车辆位姿,判断所述初始车辆位姿指示的位置是否处于预设的初始化识别区域中;The judging module is configured to obtain the initial vehicle pose determined by the positioning device when it is detected that the vehicle enters the entrance of the parking lot, and determine whether the position indicated by the initial vehicle pose is in a preset initialization recognition area;
获取模块,被配置为当所述初始车辆位姿指示的位置处于预设的初始化识别区域中时,获取图像采集设备采集的停车场图像;其中,所述停车场图像为在所述初始化识别区域中采集的图像;The acquiring module is configured to acquire the parking lot image collected by the image acquisition device when the position indicated by the initial vehicle pose is in the preset initial recognition area; wherein, the parking lot image is in the initial recognition area Images collected in
检测模块,被配置为检测所述停车场图像的语义信息;其中,所述语义信息为用于标识车辆周围的标志物的信息;The detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
第一确定模块,被配置为基于所述停车场图像的语义信息和所述初始车辆位姿,通过位姿回归模型确定所述车辆的第一车辆位姿;其中,所述位姿回归模型为预先根据在所述初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;The first determining module is configured to determine the first vehicle pose of the vehicle through a pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is It is obtained by training in advance based on a plurality of sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose;
第二确定模块,被配置为根据所述第一车辆位姿,匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿。The second determining module is configured to match the semantic information of the parking lot image with the semantic information of each position point in the preset map according to the pose of the first vehicle, and determine the second vehicle position of the vehicle according to the matching result posture.
可选的,所述处理器还包括训练模块;所述训练模块,被配置为采用以下操作训练得到所述位姿回归模型:Optionally, the processor further includes a training module; the training module is configured to train to obtain the pose regression model using the following operations:
获取在所述初始化识别区域内采集的多个样本停车场图像,以及每个样本停车场图像对应的样本初始车辆位姿和标注的车辆位姿;Acquiring a plurality of sample parking lot images collected in the initial recognition area, and a sample initial vehicle pose and a marked vehicle pose corresponding to each sample parking lot image;
检测每个样本停车场图像的样本语义信息;Detect the sample semantic information of each sample parking lot image;
基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿;Based on the semantic information of each sample and the corresponding initial vehicle pose, the reference vehicle pose is determined through the model parameters in the pose regression model;
确定所述参考车辆位姿与所述标注的车辆位姿之间的差异量;Determining the amount of difference between the reference vehicle pose and the marked vehicle pose;
当所述差异量大于预设差异量阈值时,修正所述模型参数,返回执行所述基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿的操作;When the difference amount is greater than the preset difference amount threshold, modify the model parameters, return to execute the initial vehicle pose based on the semantic information of each sample and the corresponding sample, and determine the reference vehicle based on the model parameters in the pose regression model Posture operation;
当所述差异量不大于所述预设差异量阈值时,确定所述位姿回归模型训练完成。When the difference amount is not greater than the preset difference amount threshold, it is determined that the training of the pose regression model is completed.
可选的,所述第二确定模块,具体被配置为:Optionally, the second determining module is specifically configured as:
匹配所述停车场图像的语义信息与所述预设地图中各个位置点的语义信息,得到匹配成功的语义信息在所述预设地图中对应的目标位置;Matching the semantic information of the parking lot image with the semantic information of each location point in the preset map to obtain the target location corresponding to the successfully matched semantic information in the preset map;
采用以下迭代操作中的一种确定所述车辆的第二车辆位姿;Use one of the following iterative operations to determine the second vehicle pose of the vehicle;
以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;The first vehicle pose is used as the initial value of the estimated pose, and the parking lot is calculated according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image The semantic information of the image is mapped to the first mapping position in the preset map;
确定所述第一映射位置与所述目标位置之间的第一误差;Determining a first error between the first mapping position and the target position;
当所述第一误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;When the first error is greater than the preset error threshold, the value of the estimated pose is adjusted, and the execution returns to the parking lot image according to the value of the estimated pose and the semantic information of the parking lot image. Calculate the semantic information of the parking lot image to be mapped to the first mapping position in the preset map;
当所述第一误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿;When the first error is not greater than the preset error threshold, determine the second vehicle pose of the vehicle according to the current value of the estimated pose;
或者,or,
以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置;Taking the first vehicle pose as the initial value of the estimated pose, and according to the value of the estimated pose and the target position, calculate the semantic information that is successfully matched in the preset map in the parking lot image The second mapping position in;
确定所述第二映射位置与所述停车场图像的语义信息在所述停车场图像中的位置之间的第二误差;Determining a second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image;
当所述第二误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置;When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation based on the value of the estimated pose and the target position to calculate the matching success in the preset map The second mapping position of the semantic information of in the parking lot image;
当所述第二误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿。When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
可选的,所述处理器还包括验证模块;所述验证模块,被配置为采用以下操作验证停车场入口定位是否成功:Optionally, the processor further includes a verification module; the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful:
在确定所述车辆的第二车辆位姿之后,获取当所述定位设备确定的多个初始车辆位姿指示的位置处于所述初始化识别区域时,多个停车场图像帧对应的所述车辆的第二车辆位姿;After determining the second vehicle pose of the vehicle, obtain the position of the vehicle corresponding to the multiple parking lot image frames when the position indicated by the multiple initial vehicle poses determined by the positioning device is in the initialization recognition area The second vehicle pose;
获取根据里程计采集的里程计信息确定的多个第三车辆位姿;Acquire multiple third vehicle poses determined according to the odometer information collected by the odometer;
确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
当所述残差小于预设残差阈值时,确定所述车辆在停车场入口定位成功,以所述多个第二车辆位姿作为所述车辆在停车场入口的成功定位信息。When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
可选的,所述验证模块,确定多个第二车辆位姿和多个第三车辆位姿之间的残差时,包括:Optionally, when the verification module determines the residuals between multiple second vehicle poses and multiple third vehicle poses, it includes:
通过最小二乘法求解以下函数,得到多个第二车辆位姿和多个第三车辆位姿之间的刚性变换矩阵T:Solve the following function by the least square method to obtain the rigid transformation matrix T between multiple second vehicle poses and multiple third vehicle poses:
Figure PCTCN2019113487-appb-000009
Figure PCTCN2019113487-appb-000009
将求解得到的所述T代入
Figure PCTCN2019113487-appb-000010
得到多个第二车辆位姿和多个第三车辆位姿之间 残差;
Substitute the T obtained by the solution into
Figure PCTCN2019113487-appb-000010
Obtain residuals between multiple second vehicle poses and multiple third vehicle poses;
其中,所述
Figure PCTCN2019113487-appb-000011
为第i个第二车辆位姿,所述
Figure PCTCN2019113487-appb-000012
为第i个第三车辆位姿,所述N为所述第二车辆位姿或第三车辆位姿的总数量,所述min为求最小值函数,所述‖·‖为范数符号。
Among them, the
Figure PCTCN2019113487-appb-000011
Is the i-th second vehicle pose, the
Figure PCTCN2019113487-appb-000012
Is the i-th third vehicle pose, the N is the total number of the second vehicle pose or the third vehicle pose, the min is the minimum value function, and the ‖·‖ is the norm symbol.
可选的,检测模块,具体被配置为:Optionally, the detection module is specifically configured as:
将所述停车场图像转换至俯视图坐标系下,得到地面图像;Convert the parking lot image to the top view coordinate system to obtain a ground image;
对所述地面图像进行二值化处理,得到处理后图像;Binarize the ground image to obtain a processed image;
根据所述处理后图像中的信息,确定所述停车场图像的语义信息。Determine the semantic information of the parking lot image according to the information in the processed image.
由上述内容可知,本发明实施例提供的泊车定位中的停车场入口定位方法、装置及车载终端,可以在车辆位于预设的初始化识别区域中时,将停车场图像的语义信息和定位模块确定的初始车辆位姿作为位姿回归模型的输入,由位姿回归模型确定车辆的第一车辆位姿,位姿回归模型为根据初始化识别区域中的样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到的,根据该位姿回归模型确定的第一车辆位姿相比于初始车辆位姿精度更高;再通过与预设地图中的语义信息的匹配,能够在第一车辆位姿的基础上更进一步缩小定位范围,因此本发明实施例能够提高在停车场入口处的定位精度。当然,实施本发明的任一产品或方法并不一定需要同时达到以上所述的所有优点。It can be seen from the above content that the parking lot entrance locating method, device and vehicle-mounted terminal in parking locating provided by the embodiments of the present invention can combine the semantic information of the parking lot image with the positioning module when the vehicle is in the preset initialization recognition area. The determined initial vehicle pose is used as the input of the pose regression model, and the first vehicle pose of the vehicle is determined by the pose regression model. The pose regression model is based on the sample parking lot image in the initial recognition area and the corresponding sample initial vehicle position The pose and the labeled vehicle pose are trained, and the first vehicle pose determined according to the pose regression model has a higher accuracy than the initial vehicle pose; then by matching with the semantic information in the preset map, Based on the pose of the first vehicle, the positioning range is further reduced. Therefore, the embodiment of the present invention can improve the positioning accuracy at the entrance of the parking lot. Of course, implementing any product or method of the present invention does not necessarily need to achieve all the advantages described above at the same time.
本发明实施例的创新点包括:The innovative points of the embodiments of the present invention include:
1、在停车场入口处,当利用GPS的定位结果确定车辆驶入初始化识别区域中时,可以利用图像中的语义信息缩小车辆的定位范围,再利用语义信息与语义地图的匹配,进一步缩小车辆的定位范围,从而确定车辆在停车场入口处更精确的车辆位姿,作为车辆的初始化位姿。1. At the entrance of the parking lot, when the GPS positioning result is used to determine that the vehicle enters the initial recognition area, the semantic information in the image can be used to narrow the positioning range of the vehicle, and then the semantic information and semantic map matching can be used to further reduce the vehicle In order to determine the more accurate vehicle pose at the entrance of the parking lot, as the initial pose of the vehicle.
2、将在初始化识别区域内针对多帧图像确定的初始化位姿与根据里程计确定的位姿进行交叉验证,判断位姿初始化是否成功,能够更准确地判断车辆的位姿初始化是否成功,即判断确定的车辆位姿的精确度是否足够。2. Cross-validate the initialization pose determined for the multi-frame images in the initialization recognition area with the pose determined according to the odometer to determine whether the pose initialization is successful, and it can more accurately determine whether the vehicle's pose initialization is successful, that is Determine whether the accuracy of the determined vehicle pose is sufficient.
附图说明Description of the drawings
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单介绍。显而易见地,下面描述中的附图仅仅是本发明的一些实施例。对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to explain the embodiments of the present invention or the technical solutions in the prior art more clearly, the following will briefly introduce the drawings that need to be used in the description of the embodiments or the prior art. Obviously, the drawings in the following description are only some embodiments of the present invention. For those of ordinary skill in the art, other drawings can be obtained from these drawings without creative work.
图1为本发明实施例提供的一种泊车定位中的停车场入口定位方法的流程示意图;FIG. 1 is a schematic flowchart of a parking lot entrance positioning method in parking positioning according to an embodiment of the present invention;
图2为本发明实施例提供的停车场地面标志线及初始化识别区域的一种示意图;2 is a schematic diagram of a parking lot ground marking line and an initial recognition area provided by an embodiment of the present invention;
图3为根据停车场图像确定的地面图像的一种示意图;Figure 3 is a schematic diagram of a ground image determined according to a parking lot image;
图4为在图2中停车场入口处的初始化识别区域内车辆的行驶轨迹参考图;Fig. 4 is a reference diagram of the driving track of the vehicle in the initial recognition area at the entrance of the parking lot in Fig. 2;
图5为本发明实施例提供的一种泊车定位中的停车场入口定位装置的结构示意图;5 is a schematic structural diagram of a parking lot entrance positioning device in parking positioning according to an embodiment of the present invention;
图6为本发明实施例提供的一种车载终端的结构示意图。Fig. 6 is a schematic structural diagram of a vehicle-mounted terminal provided by an embodiment of the present invention.
具体实施方式Detailed ways
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整的描述。显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. 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 those of ordinary skill in the art without creative work shall fall within the protection scope of the present invention.
需要说明的是,本发明实施例及附图中的术语“包括”和“具有”以及它们的任何变形,意图在于覆盖不排他的包含。例如包含的一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元,而是可选地还包括没有列出的步骤或单元,或可选地还包括对于这些过程、方法、产品或设备固有的其他步骤或单元。It should be noted that the terms "including" and "having" in the embodiments of the present invention and the drawings and any variations thereof are intended to cover non-exclusive inclusions. For example, the process, method, system, product or device that contains a series of steps or units is not limited to the listed steps or units, but optionally also includes unlisted steps or units, or optionally also includes Other steps or units inherent to these processes, methods, products or equipment.
本发明实施例公开了一种泊车定位中的停车场入口定位方法、装置及车载终端,能够提高在停车场入口处的定位精度。下面对本发明实施例进行详细说明。The embodiment of the present invention discloses a parking lot entrance positioning method, device and vehicle-mounted terminal in parking positioning, which can improve the positioning accuracy at the entrance of the parking lot. The embodiments of the present invention will be described in detail below.
图1为本发明实施例提供的一种泊车定位中的停车场入口定位方法的流程示意图。该方法应用于 电子设备。该电子设备可以为普通计算机、服务器或者智能终端设备等,也可以为安装于车辆中的车载终端。其中,停车场可以为室内停车场或地下车库。该方法具体包括以下步骤。FIG. 1 is a schematic flowchart of a parking lot entrance positioning method in parking positioning according to an embodiment of the present invention. This method is applied to electronic equipment. The electronic device may be an ordinary computer, a server, or an intelligent terminal device, etc., or may be a vehicle-mounted terminal installed in the vehicle. Among them, the parking lot can be an indoor parking lot or an underground garage. The method specifically includes the following steps.
步骤S110:当检测到车辆驶入停车场入口处时,获取定位模块确定的初始车辆位姿,判断初始车辆位姿指示的位置是否处于预设的初始化识别区域中。Step S110: When it is detected that the vehicle has entered the entrance of the parking lot, the initial vehicle pose determined by the positioning module is acquired, and it is determined whether the position indicated by the initial vehicle pose is in the preset initialization recognition area.
如果处于,则执行步骤S120;如果不处于,可以在车辆行驶的过程中继续获取定位模块确定的新的初始车辆位姿,执行判断初始车辆位姿指示的位置是否处于预设的初始化识别区域中的步骤。If it is, proceed to step S120; if it is not, continue to obtain the new initial vehicle pose determined by the positioning module while the vehicle is running, and execute to determine whether the position indicated by the initial vehicle pose is in the preset initialization recognition area A step of.
本实施例中,根据车辆中的定位模块采集的数据可以实时地确定车辆在预设地图中位置,当检测到车辆驶入停车场入口处所在的位置时,获取驶入停车场入口处时定位模块确定的初始车辆位姿。In this embodiment, the position of the vehicle on the preset map can be determined in real time according to the data collected by the positioning module in the vehicle. When the vehicle is detected to enter the location of the entrance of the parking lot, the location when entering the entrance of the parking lot is obtained. The initial vehicle pose determined by the module.
其中,车辆位姿可以包括车辆的坐标位置和车辆朝向信息。预设地图可以为预先建立的高精度地图。定位模块可以为全球定位系统(Global Positioning System,GPS)模块或者北斗卫星导航系统(BeiDou Navigation Satellite System,BDS)模块。本申请中的车辆可以理解为智能车辆。Among them, the vehicle pose may include the coordinate position of the vehicle and the vehicle orientation information. The preset map may be a high-precision map established in advance. The positioning module may be a global positioning system (Global Positioning System, GPS) module or a BeiDou Navigation Satellite System (BeiDou Navigation Satellite System, BDS) module. The vehicle in this application can be understood as an intelligent vehicle.
初始化识别区域为预先设定的预设地图中的坐标区域,在该初始化识别区域内,任意两个位置的观测或同一位置的不同角度观测存在显著差异。在该初始化识别区域中,可以精确地确定车辆的位置,作为车辆进入停车场时的初始定位位置。在进入停车场内部时,会根据该初始定位位置进行实时定位。初始化识别区域可以为以停车场入口处的预设位置点为圆心、以预设距离为半径的圆形区域。例如,预设距离可以为15m或其他数值。The initial recognition area is a preset coordinate area in the preset map. In the initial recognition area, there are significant differences in the observation of any two positions or the observation of the same position from different angles. In the initial recognition area, the position of the vehicle can be accurately determined as the initial positioning position when the vehicle enters the parking lot. When entering the parking lot, real-time positioning will be performed according to the initial positioning position. The initial recognition area may be a circular area with the preset location point at the entrance of the parking lot as the center and the preset distance as the radius. For example, the preset distance can be 15m or other values.
参见图2,该图2为本发明实施例提供的停车场地面标志线及初始化识别区域的一种示意图。其中,显示了停车场地面的标志线,以及停车场入口通道的墙壁(采用粗线表示),停车场入口处的初始化识别区域采用较大圆形区域表示。当车辆位于A点时,定位模块能够定位到较大圆形区域中。图2中较小的圆圈范围表示能够正常启动定位系统的初始位姿范围。Refer to FIG. 2, which is a schematic diagram of a parking lot ground marking line and an initial recognition area provided by an embodiment of the present invention. Among them, the marking line on the ground of the parking lot and the wall of the entrance passage of the parking lot are shown (indicated by thick lines), and the initial recognition area at the entrance of the parking lot is represented by a larger circular area. When the vehicle is at point A, the positioning module can be positioned in a larger circular area. The smaller circle range in Figure 2 represents the initial pose range that can normally start the positioning system.
本步骤中,GPS等信号起到的作用是确定车辆已经进入以15m为半径的初始化识别区域内,这样可以避免在有类似地形的区域发生误检。初始化识别区域也可以为多个,根据GPS数据可以从多个初始化识别区域中确定车辆驶入的目标初始化识别区域。In this step, the function of GPS and other signals is to determine that the vehicle has entered the initial recognition area with a radius of 15m, so as to avoid misdetection in areas with similar terrain. There may also be multiple initialization recognition areas, and the target initialization recognition area that the vehicle has entered can be determined from the multiple initialization recognition areas according to GPS data.
步骤S120:获取相机模块采集的停车场图像。Step S120: Acquire parking lot images collected by the camera module.
其中,停车场图像为在初始化识别区域中采集的图像。车辆中的相机模块和定位模块可以均按照一定的周期采集数据。本步骤中,获取的停车场图像可以为:与指示的位置处于初始化识别区域中的初始车辆位姿在约定时刻采集。约定时刻,可以理解为相同时刻,或者两个时间差较短的时刻。Among them, the parking lot image is the image collected in the initial recognition area. The camera module and positioning module in the vehicle can both collect data according to a certain period. In this step, the acquired parking lot image may be: the initial vehicle pose and the indicated position in the initial recognition area are collected at the appointed time. The appointed time can be understood as the same time or two moments with a short time difference.
当车辆从停车场入口驶入停车场时,相机模块采集的停车场图像可以为包含停车场内部环境的图像。When the vehicle enters the parking lot from the entrance of the parking lot, the parking lot image collected by the camera module may be an image containing the internal environment of the parking lot.
步骤S130:检测停车场图像的语义信息。Step S130: Detect the semantic information of the parking lot image.
其中,语义信息为用于标识车辆周围的标志物的信息。语义信息可以包括但不限于路面的车道线、车库线、指示箭头、路标、建筑、人行道等标志物对应的信息。语义信息可以为图像中多种标志物之间的相对位置信息。Among them, the semantic information is information used to identify landmarks around the vehicle. The semantic information may include, but is not limited to, information corresponding to landmarks such as lane lines, garage lines, indicating arrows, road signs, buildings, and sidewalks on the road surface. The semantic information can be the relative position information between various markers in the image.
在一种实施方式中,检测停车场图像的语义信息的步骤具体可以包括:In an embodiment, the step of detecting the semantic information of the parking lot image may specifically include:
将停车场图像转换至俯视图坐标系下,得到地面图像;对地面图像进行二值化处理,得到处理后图像;根据所述处理后图像中的信息,确定停车场图像的语义信息。The parking lot image is converted to the top view coordinate system to obtain the ground image; the ground image is binarized to obtain the processed image; the semantic information of the parking lot image is determined according to the information in the processed image.
其中,地面图像可以为灰度图像。对地面图像进行二值化处理时,可以采用大津法确定用于区分地面图像前景与背景部分的像素阈值,根据该确定的像素阈值对地面图像进行二值化处理,得到包含前景部分的处理后图像。Among them, the ground image can be a grayscale image. When the ground image is binarized, the Otsu method can be used to determine the pixel threshold used to distinguish the foreground and background part of the ground image, and the ground image is binarized according to the determined pixel threshold to obtain the processed foreground part image.
根据处理后的图像中的信息确定停车场图像的语义信息时,可以直接将处理后的图像作为语义信息,也可以根据处理后图像中各个标志物之间的相对位置信息作为语义信息。When determining the semantic information of the parking lot image based on the information in the processed image, the processed image can be directly used as the semantic information, or the relative position information between the various landmarks in the processed image can be used as the semantic information.
参见图3,该图3为根据停车场图像确定的地面图像的一种示意图。其中的线为墙壁线和地面上的车道线,对该地面图像进行二值化处理后,可以得到包含语义信息的图像,其中的语义信息可以为各种线条之间的相对位置等。二值化处理后的图像可以称为语义观测图像。Refer to Fig. 3, which is a schematic diagram of a ground image determined according to a parking lot image. The lines are wall lines and lane lines on the ground. After binarizing the ground image, an image containing semantic information can be obtained. The semantic information can be the relative position between various lines. The image after binarization can be called a semantic observation image.
步骤S140:基于停车场图像的语义信息和初始车辆位姿,通过位姿回归模型确定车辆的第一车辆位姿。Step S140: Based on the semantic information of the parking lot image and the initial vehicle pose, the first vehicle pose of the vehicle is determined through the pose regression model.
其中,位姿回归模型为预先根据在初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到。该位姿回归模型能够根据训练好的模型参数使得停车场图像的语义信息和初始车辆位姿,与第一车辆位姿相关联。Among them, the pose regression model is obtained by pre-training based on multiple sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose. The pose regression model can associate the semantic information of the parking lot image and the initial vehicle pose with the first vehicle pose according to the trained model parameters.
本步骤具体可以包括:将停车场图像的语义信息和初始车辆位姿作为输入信息输入位姿回归模型,获取位姿回归模型输出的车辆的第一车辆位姿。其中,第一车辆位姿为比初始车辆位姿更精确的车辆位姿。位姿回归模型根据训练好的模型参数可以在初始车辆位姿的基础上,根据从停车场图像的语义信息中提取的特征向量进行回归,得到第一车辆位姿。This step may specifically include: inputting the semantic information of the parking lot image and the initial vehicle pose as input information into the pose regression model, and obtaining the first vehicle pose of the vehicle output by the pose regression model. Among them, the first vehicle pose is a vehicle pose that is more accurate than the initial vehicle pose. According to the trained model parameters, the pose regression model can perform regression on the basis of the initial vehicle pose and the feature vector extracted from the semantic information of the parking lot image to obtain the first vehicle pose.
位姿回归模块可以采用多级位姿回归器(Cascaded Pose Regression,CPR)。多级位姿回归器采用以下原理公式,确定第一车辆位姿:The pose regression module can use a multi-stage pose regression (Cascaded Pose Regression, CPR). The multi-stage pose regression adopts the following principle formula to determine the pose of the first vehicle:
P reg=CPR(P GPS,I seg) P reg =CPR(P GPS ,I seg )
其中,P GPS为初始车辆位姿,I seg为语义观测图像,即停车场图像的语义信息。P GPS和I seg为CPR的输入信息,P reg为CPR输出的第一车辆位姿。 Among them, P GPS is the initial vehicle pose, and Iseg is the semantic observation image, that is, the semantic information of the parking lot image. P GPS and I seg are the input information of CPR, and P reg is the first vehicle pose output by CPR.
本步骤能够基于语义信息和初始车辆位姿,通过多级位姿回归器确定车辆更准确的位姿,在步骤S110确定车辆进入以15m为半径的初始化识别区域的基础上,使得定位的位姿更精确。本步骤也可以理解为,识别出图3在图2中的位置。In this step, based on the semantic information and the initial vehicle pose, the more accurate pose of the vehicle can be determined by the multi-level pose regression. In step S110, it is determined that the vehicle enters the initial recognition area with a radius of 15m, so that the positioning pose more accurate. This step can also be understood as identifying the position of FIG. 3 in FIG. 2.
步骤S150:根据第一车辆位姿,匹配停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定车辆的第二车辆位姿。Step S150: According to the first vehicle pose, match the semantic information of the parking lot image with the semantic information of each location point in the preset map, and determine the second vehicle pose of the vehicle according to the matching result.
由于车辆的停车场图像中的语义信息会受到遮挡等外部因素的影响,第一车辆位姿与真实的车辆位姿之间可能存在一定的偏差或者发生误检。因此,通过本步骤可以进一步提高车辆位姿的精确性。Since the semantic information in the parking lot image of the vehicle will be affected by external factors such as occlusion, there may be a certain deviation or misdetection between the first vehicle pose and the real vehicle pose. Therefore, this step can further improve the accuracy of the vehicle pose.
本步骤中,在得到第一车辆位姿之后,可以将停车场图像的语义信息与预设地图中各个位置点的语义信息进行匹配,根据匹配成功的位置点确定更精确的第二车辆位姿。In this step, after the first vehicle pose is obtained, the semantic information of the parking lot image can be matched with the semantic information of each location point in the preset map, and a more accurate second vehicle pose can be determined according to the location point that is successfully matched. .
第二车辆位姿,可以理解为在初始化识别区域中定位得到的车辆的满足一定精度要求的初始位姿。在确定该初始位姿时,能够为启动停车场内基于视觉和语义地图对车辆的实时定位。The second vehicle pose can be understood as the initial pose of the vehicle that is located in the initial recognition area and meets a certain accuracy requirement. When determining the initial pose, it can start real-time positioning of the vehicle based on the visual and semantic map in the parking lot.
由上述内容可知,本实施例可以在车辆位于预设的初始化识别区域中时,将停车场图像的语义信息和定位模块确定的初始车辆位姿作为位姿回归模型的输入,由位姿回归模型确定车辆的第一车辆位姿,位姿回归模型为根据初始化识别区域中的样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到的,根据该位姿回归模型确定的第一车辆位姿相比于初始车辆位姿精度更高;再通过与预设地图中的语义信息的匹配,能够在第一车辆位姿的基础上更进一步缩小定位范围,因此本实施例能够提高在停车场入口处的定位精度。即,本实施例能够使用GPS等定位信号在泊车区域的入口区域准确地为定位系统提供初值,以使得定位系统能够正常启动。It can be seen from the above content that this embodiment can use the semantic information of the parking lot image and the initial vehicle pose determined by the positioning module as the input of the pose regression model when the vehicle is in the preset initialization recognition area. Determine the first vehicle pose of the vehicle. The pose regression model is trained based on the sample parking lot image in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose. The pose regression model is determined Compared with the initial vehicle pose, the first vehicle pose has a higher accuracy; and by matching with the semantic information in the preset map, the positioning range can be further reduced on the basis of the first vehicle pose. Therefore, this embodiment can Improve the positioning accuracy at the entrance of the parking lot. That is, this embodiment can use positioning signals such as GPS to accurately provide an initial value for the positioning system in the entrance area of the parking area, so that the positioning system can be started normally.
本实施例对GPS等定位模块的位置精度依赖性较小。同时,针对停车场中的标志物被遮挡的情况也具有较强的鲁棒性。本实施例中确定第二车辆位姿的效率较高,能够在算力有限的嵌入式计算设备上达到实时运行。This embodiment is less dependent on the position accuracy of positioning modules such as GPS. At the same time, it also has strong robustness against the situation that the signs in the parking lot are blocked. In this embodiment, the efficiency of determining the pose of the second vehicle is high, and real-time operation can be achieved on an embedded computing device with limited computing power.
在本发明的另一实施例中,基于图1所示实施例,位姿回归模型可以采用以下步骤1a~5a训练得到。In another embodiment of the present invention, based on the embodiment shown in FIG. 1, the pose regression model can be obtained by training in the following steps 1a to 5a.
步骤1a:获取在初始化识别区域内采集的多个样本停车场图像,以及每个样本停车场图像对应的样本初始车辆位姿和标注的车辆位姿。Step 1a: Acquire multiple sample parking lot images collected in the initial recognition area, and the sample initial vehicle pose and the marked vehicle pose corresponding to each sample parking lot image.
其中,标注的车辆位姿可以理解为样本停车场图像对应的车辆位姿的真实值、标准值。样本初始车辆位姿可以为在采集每个样本停车场图像时定位模块确定的车辆位姿,也可以为对标注的车辆位姿添加预设扰动后得到的车辆位姿。预设扰动可以理解为预设修改。样本初始车辆位姿可以理解为用于输入位姿回归模型的车辆位姿初始值,位姿回归模型在该车辆位姿初始值的基础上对样本停车场图像进行回归。Among them, the marked vehicle pose can be understood as the true value and standard value of the vehicle pose corresponding to the sample parking lot image. The sample initial vehicle pose may be the vehicle pose determined by the positioning module when collecting each sample parking lot image, or it may be the vehicle pose obtained by adding preset disturbances to the marked vehicle pose. The preset disturbance can be understood as a preset modification. The sample initial vehicle pose can be understood as the initial value of the vehicle pose used to input the pose regression model, and the pose regression model regresses the sample parking lot image on the basis of the initial value of the vehicle pose.
在一种实施方式中,可以预先在初始化识别区域内通过相机模块采集大量的样本停车场图像,以 及定位模块确定的样本初始车辆位姿。在采集每个样本停车场图像时,可以通过离线定位的方式确定该样本停车场图像对应的标注的车辆位姿。In one embodiment, a large number of sample parking lot images can be collected in advance through the camera module in the initial recognition area, and the sample initial vehicle pose determined by the positioning module. When collecting each sample parking lot image, the marked vehicle pose corresponding to the sample parking lot image can be determined by offline positioning.
在另一实施方式中,可以直接使用预设地图中的语义信息和多个虚拟行驶轨迹,模拟车辆中的相机模块的采集过程,得到大量模拟图像,作为样本停车场图像。并且,可以直接根据预设地图确定模拟图像对应的标注的车辆位姿。In another embodiment, the semantic information in the preset map and multiple virtual driving trajectories can be directly used to simulate the collection process of the camera module in the vehicle to obtain a large number of simulated images as sample parking lot images. In addition, the marked vehicle pose corresponding to the simulated image can be determined directly according to the preset map.
参见图4,该图4为在图2中停车场入口处的初始化识别区域内,采集样本数据时车辆的行驶轨迹参考图,其中停车场入口处的不规则灰色线条代表车辆行驶轨迹。Refer to Figure 4, which is a reference diagram of the vehicle's trajectory when collecting sample data in the initial recognition area at the entrance of the parking lot in Figure 2, where the irregular gray lines at the entrance of the parking lot represent the trajectory of the vehicle.
步骤2a:检测每个样本停车场图像的样本语义信息。Step 2a: Detect the sample semantic information of each sample parking lot image.
本步骤的具体说明可以参见步骤S130的说明部分。For a specific description of this step, refer to the description part of step S130.
步骤3a:基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿。Step 3a: Based on the semantic information of each sample and the corresponding sample initial vehicle pose, the reference vehicle pose is determined through the model parameters in the pose regression model.
其中,当位姿回归模型采用多级位姿回归器时,可以直接将多级位姿回归器中已经在其他方面训练过的模型参数,作为本步骤中模型参数的初始值。通过大量的训练过程,不断地修正模型参数,使其逐渐接近真实值。Among them, when the pose regression model adopts a multi-level pose regressor, the model parameters that have been trained in other aspects in the multi-level pose regressor can be directly used as the initial values of the model parameters in this step. Through a large number of training processes, the model parameters are constantly revised to gradually approach the true value.
步骤4a:确定参考车辆位姿与标注的车辆位姿之间的差异量。Step 4a: Determine the amount of difference between the reference vehicle pose and the marked vehicle pose.
具体的,可以采用残差函数确定参考车辆位姿与标注的车辆位姿之间的差异量。Specifically, the residual function may be used to determine the amount of difference between the reference vehicle pose and the marked vehicle pose.
步骤5a:当上述差异量大于预设差异量阈值时,修正模型参数,返回执行步骤3a。当差异量不大于预设差异量阈值时,确定位姿回归模型训练完成。Step 5a: When the above difference amount is greater than the preset difference amount threshold, correct the model parameters and return to step 3a. When the difference amount is not greater than the preset difference amount threshold, it is determined that the pose regression model training is completed.
其中,预设差异量阈值为预先根据经验设定的值。当差异量大于预设差异量阈值时,认为需要继续训练模型。在修正模型参数时,可以根据该差异量修正模型参数。例如,可以根据该差异量和与上次训练过程的差异量相比得到的变化趋势,修正模型参数。Among them, the preset difference threshold is a value set in advance based on experience. When the difference amount is greater than the preset difference amount threshold, it is considered that the model needs to be continuously trained. When modifying the model parameters, the model parameters can be modified according to the difference. For example, the model parameters can be corrected based on the difference amount and the change trend obtained from the difference amount in the previous training process.
综上,本实施例提供了对位姿回归模型进行训练的一种具体实施方式,能够提高位姿回归模型的准确性,进而提高定位的精确性。In summary, this embodiment provides a specific implementation manner for training the pose regression model, which can improve the accuracy of the pose regression model, thereby improving the accuracy of positioning.
在本发明的另一实施例中,基于图1所示实施例,步骤S150,根据第一车辆位姿,匹配停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿的步骤,可以包括以下实施方式。In another embodiment of the present invention, based on the embodiment shown in FIG. 1, in step S150, according to the first vehicle pose, the semantic information of the parking lot image is matched with the semantic information of each location point in the preset map, and according to the matching result The step of determining the second vehicle pose of the vehicle may include the following embodiments.
实施方式一包括以下步骤1b~5b。The first embodiment includes the following steps 1b to 5b.
步骤1b:匹配停车场图像的语义信息与所述预设地图中各个位置点的语义信息,得到匹配成功的语义信息在预设地图中对应的目标位置。Step 1b: Match the semantic information of the parking lot image with the semantic information of each location point in the preset map, and obtain the target location of the successfully matched semantic information in the preset map.
步骤2b:以第一车辆位姿作为估计位姿的初始取值,根据估计位姿的取值以及停车场图像的语义信息在停车场图像中的位置,计算停车场图像的语义信息映射至预设地图中的第一映射位置。Step 2b: Use the first vehicle pose as the initial value of the estimated pose, and calculate the semantic information mapping of the parking lot image to the prediction based on the estimated pose value and the position of the semantic information of the parking lot image in the parking lot image. Set the first mapping position in the map.
本步骤中,将停车场图像的语义信息映射至预设地图中的第一映射位置,可以理解为,将停车场图像的语义信息映射至预设地图所在坐标系中,映射得到的位置为第一映射位置。In this step, mapping the semantic information of the parking lot image to the first mapping position in the preset map can be understood as mapping the semantic information of the parking lot image to the coordinate system where the preset map is located, and the mapped position is the first A mapping location.
步骤3b:确定第一映射位置与目标位置之间的第一误差。Step 3b: Determine the first error between the first mapping position and the target position.
步骤4b:当第一误差大于预设误差阈值时,调整估计位姿的取值,并返回执行步骤2b中根据估计位姿的取值以及停车场图像的语义信息在停车场图像中的位置,计算停车场图像的语义信息映射至预设地图中的第一映射位置的步骤。Step 4b: When the first error is greater than the preset error threshold, adjust the value of the estimated pose, and return to perform step 2b according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image, The step of calculating the semantic information of the parking lot image to be mapped to the first mapping position in the preset map.
步骤5b:当第一误差不大于预设误差阈值时,根据估计位姿的当前取值确定所述车辆的第二车辆位姿。Step 5b: When the first error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
本步骤中,根据估计位姿的当前取值确定车辆的第二车辆位姿时,具体可以包括,将估计位姿的当前取值直接确定为车辆的第二车辆位姿;也可以包括,判断估计位姿的当前取值与第一车辆位姿之间的差值是否小于预设阈值,如果小于,则将估计位姿的当前取值直接确定为车辆的第二车辆位姿。In this step, when determining the second vehicle pose of the vehicle according to the current value of the estimated pose, it may specifically include directly determining the current value of the estimated pose as the second vehicle pose of the vehicle; it may also include, judging Whether the difference between the current value of the estimated pose and the first vehicle pose is less than a preset threshold, if it is smaller, the current value of the estimated pose is directly determined as the second vehicle pose of the vehicle.
本实施例中,当第一误差大于预设误差阈值时,认为定位的精度还没有达到要求,需要继续迭代。 当第一误差不大于预设误差阈值时,认为定位的精度已经达到要求,可以停止迭代,得出车辆的精确定位位姿。In this embodiment, when the first error is greater than the preset error threshold, it is considered that the positioning accuracy has not yet reached the requirement, and iterating needs to be continued. When the first error is not greater than the preset error threshold, it is considered that the positioning accuracy has reached the requirement, and the iteration can be stopped to obtain the precise positioning pose of the vehicle.
实施方式二包括以下步骤1c~5c。The second embodiment includes the following steps 1c to 5c.
步骤1c:匹配停车场图像的语义信息与所述预设地图中各个位置点的语义信息,得到匹配成功的语义信息在预设地图中对应的目标位置。Step 1c: match the semantic information of the parking lot image with the semantic information of each location point in the preset map, and obtain the target location of the successfully matched semantic information in the preset map.
步骤2c:以第一车辆位姿作为估计位姿的初始取值,根据估计位姿的取值以及目标位置,计算预设地图中匹配成功的语义信息在停车场图像中的第二映射位置。Step 2c: Use the first vehicle pose as the initial value of the estimated pose, and calculate the second mapping position in the parking lot image of the successfully matched semantic information in the preset map according to the estimated pose value and the target position.
其中,计算预设地图中匹配成功的语义信息在停车场图像中的第二映射位置,可以理解为,将预设地图中匹配成功的语义信息映射至停车场图像所在的坐标系,映射得到的位置为第二映射位置。Among them, calculating the second mapping position of the successfully matched semantic information in the preset map in the parking lot image can be understood as mapping the successfully matched semantic information in the preset map to the coordinate system where the parking lot image is located, and the mapping obtained The location is the second mapping location.
步骤3c:确定第二映射位置与停车场图像的语义信息在停车场图像中的位置之间的第二误差。Step 3c: Determine the second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image.
步骤4c:当第二误差大于预设误差阈值时,调整估计位姿的取值,并返回执行步骤2c中根据估计位姿的取值以及目标位置,计算预设地图中匹配成功的语义信息在停车场图像中的第二映射位置的步骤。Step 4c: When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to perform step 2c according to the value of the estimated pose and the target position to calculate the semantic information of the preset map matching successfully. Step of second mapping position in parking lot image.
步骤5c:当第二误差不大于预设误差阈值时,根据估计位姿的当前取值确定车辆的第二车辆位姿。Step 5c: When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
本实施方式中的迭代过程具体可以采用以下数据模型表示:The iterative process in this embodiment can be represented by the following data model:
P i=argmin(||X ij-f(P i,A j)||); P i =argmin(||X ij -f(P i ,A j )||);
其中,P i为i时刻车辆的位姿信息,A j为预设地图中第j个语义信息的目标位置,X ij为与第j个语义信息相匹配的语义信息在停车场图像中的位置,f(.)为投影方程,用于根据A j和P i将第j个语义信息投影至图像成像平面,其投影结果与X ij在同一坐标系中。这样,能得到估计位姿的当前取值映射的观测和实际观测的误差,通过非线性优化的方式优化车辆位姿,以求得最大似然的位姿。 Wherein, P i is the posture of the vehicle information at time i, A j is the preset target position map the j-th semantic information, X ij is a j-th semantic information and semantic information matches the location in the parking lot image , F(.) is the projection equation, used to project the j-th semantic information to the image imaging plane according to A j and P i , and the projection result is in the same coordinate system as X ij . In this way, the error of the current value mapping of the estimated pose and the actual observation can be obtained, and the vehicle pose can be optimized by means of nonlinear optimization to obtain the most likely pose.
本实施例中,根据估计位姿的取值,通过两种映射方式,将预设地图中的语义信息映射至停车场图像中,或者将停车场图像中的语义信息映射至预设地图中,计算映射信息的位置之间的差值,并根据该差值不断调整预估位姿的取值,当满足条件时,根据预估位姿确定车辆的第二车辆位姿。采用这种方式能够较为快速地迭代出车辆位姿,并且能保证一定的定位精度。In this embodiment, according to the value of the estimated pose, the semantic information in the preset map is mapped to the parking lot image, or the semantic information in the parking lot image is mapped to the preset map through two mapping methods. The difference between the positions of the mapping information is calculated, and the value of the estimated pose is continuously adjusted according to the difference. When the condition is met, the second vehicle pose of the vehicle is determined according to the estimated pose. In this way, the vehicle pose can be iterated relatively quickly, and a certain positioning accuracy can be guaranteed.
在本发明的另一实施例中,基于上述实施例,当车辆从进入初始化识别区域到离开,电子设备能够基于多个图像帧进行多次初始定位,例如电子设备可以根据预设的初始定位频率在初始化识别区域中进行图1所示的初始定位。其中,图1中的5个步骤组成一次初始定位。本实施例中,在确定车辆的第二车辆位姿之后,可以采用以下步骤1d~4d的方式验证停车场入口定位是否成功。In another embodiment of the present invention, based on the foregoing embodiment, when the vehicle enters the initial recognition area to leave, the electronic device can perform multiple initial positioning based on multiple image frames. For example, the electronic device can perform multiple initial positioning based on a preset initial positioning frequency. Perform the initial positioning shown in Figure 1 in the initial recognition area. Among them, the 5 steps in Figure 1 constitute an initial positioning. In this embodiment, after determining the second vehicle pose of the vehicle, the following steps 1d to 4d can be used to verify whether the parking lot entrance location is successful.
步骤1d:获取当定位模块确定的多个初始车辆位姿指示的位置处于初始化识别区域时,多个停车场图像帧对应的车辆的第二车辆位姿。Step 1d: Acquire the second vehicle poses of the vehicles corresponding to the multiple parking lot image frames when the positions indicated by the multiple initial vehicle poses determined by the positioning module are in the initialization recognition area.
具体的,可以按照预设的初始定位频率,采用图1中的5个步骤确定多个第二车辆位姿,并将每个第二车辆位姿存储至预设存储空间。在获取上述多个停车场图像帧对应的车辆的第二车辆位姿时,可以从预设存储空间获取。Specifically, according to a preset initial positioning frequency, a plurality of second vehicle poses may be determined using the five steps in FIG. 1, and each second vehicle pose may be stored in a preset storage space. When acquiring the second vehicle pose of the vehicle corresponding to the multiple parking lot image frames, it may be acquired from a preset storage space.
步骤2d:获取根据里程计采集的里程计信息确定的多个第三车辆位姿。Step 2d: Obtain multiple third vehicle poses determined according to the odometer information collected by the odometer.
本实施例中,车辆中的里程计可以周期性地采集里程计信息,并根据上一里程计信息和该里程计信息,可以估测出车辆位姿,作为第三车辆位姿。In this embodiment, the odometer in the vehicle can periodically collect odometer information, and based on the previous odometer information and the odometer information, the vehicle pose can be estimated as the third vehicle pose.
其中,根据里程计信息确定的多个第三车辆位姿,可以为在预设的里程计地图中的位姿信息。Among them, the multiple third vehicle poses determined according to the odometer information may be the pose information in the preset odometer map.
在一种实施方式中,确定第二车辆位姿和确定第三车辆位姿的频率可以相同,且当车辆行驶至某一位置时,同时进行确定第二车辆位姿和确定第三车辆位姿的操作。即,第二车辆位姿和第三车辆位姿可以一一对应。In one embodiment, the frequency of determining the second vehicle pose and determining the third vehicle pose may be the same, and when the vehicle travels to a certain position, the second vehicle pose and the third vehicle pose are determined simultaneously Operation. That is, the second vehicle pose and the third vehicle pose may have a one-to-one correspondence.
步骤3d:确定多个第二车辆位姿和多个第三车辆位姿之间的残差。Step 3d: Determine residuals between multiple second vehicle poses and multiple third vehicle poses.
本步骤具体可以包括:确定一一对应的第二车辆位姿和第三车辆位姿之间的残差。所确定的残差 可以是每个第二车辆位姿和对应的第三车辆位姿之间的残差的和,也可以是由每个第二车辆位姿和对应的第三车辆位姿之间的残差组成的残差向量。This step may specifically include: determining a residual error between the second vehicle pose and the third vehicle pose in a one-to-one correspondence. The determined residual may be the sum of the residuals between each second vehicle pose and the corresponding third vehicle pose, or it may be the sum of the residuals between each second vehicle pose and the corresponding third vehicle pose. The residual vector composed of the residuals between.
步骤4d:当残差小于预设残差阈值时,确定车辆在停车场入口定位成功,以多个第二车辆位姿作为车辆在停车场入口的成功定位信息。Step 4d: When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and multiple second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
其中,预设残差阈值可以为预先根据经验确定的值。当残差不小于预设残差阈值时,认为车辆在停车场入口定位失败。Wherein, the preset residual threshold may be a value determined in advance based on experience. When the residual is not less than the preset residual threshold, it is considered that the vehicle has failed to locate at the entrance of the parking lot.
综上,本实施例采用在初始化识别区域中,针对多个停车场图像帧的车辆位姿与里程计的车辆位姿进行交叉验证,能够有效地降低定位初始化的误检率。当交叉验证成功时,确定停车场入口的初始定位过程成功,这样能够更加准确地验证初始定位的精度是否达到要求,提高定位精度。In summary, this embodiment adopts in the initialization recognition area to cross-validate the vehicle pose of multiple parking lot image frames and the vehicle pose of the odometer, which can effectively reduce the false detection rate of positioning initialization. When the cross-validation is successful, it is determined that the initial positioning process of the entrance of the parking lot is successful, which can more accurately verify whether the accuracy of the initial positioning meets the requirements and improve the positioning accuracy.
在本发明的另一实施例中,基于上述实施例,步骤3d,确定多个第二车辆位姿和多个第三车辆位姿之间的残差的步骤,具体可以包括:In another embodiment of the present invention, based on the above-mentioned embodiment, step 3d, the step of determining the residuals between the multiple second vehicle poses and the multiple third vehicle poses may specifically include:
通过最小二乘法求解以下函数,得到多个第二车辆位姿和多个第三车辆位姿之间的刚性变换矩阵T,将求解得到的T代入
Figure PCTCN2019113487-appb-000013
得到多个第二车辆位姿和多个第三车辆位姿之间残差:
Solve the following function by the least square method to obtain the rigid transformation matrix T between multiple second vehicle poses and multiple third vehicle poses, and substitute the obtained T into
Figure PCTCN2019113487-appb-000013
Obtain the residuals between multiple second vehicle poses and multiple third vehicle poses:
Figure PCTCN2019113487-appb-000014
Figure PCTCN2019113487-appb-000014
其中,
Figure PCTCN2019113487-appb-000015
为第i个第二车辆位姿,
Figure PCTCN2019113487-appb-000016
为第i个第三车辆位姿,N为第二车辆位姿或第三车辆位姿的总数量,min为求最小值函数,‖·‖为范数符号。
among them,
Figure PCTCN2019113487-appb-000015
Is the i-th second vehicle pose,
Figure PCTCN2019113487-appb-000016
Is the i-th third vehicle pose, N is the total number of the second vehicle pose or the third vehicle pose, min is the minimum function, and ‖·‖ is the norm symbol.
在初始化识别区域内,根据多个停车场图像帧确定的第二车辆位姿可以采用第一轨迹
Figure PCTCN2019113487-appb-000017
Figure PCTCN2019113487-appb-000018
表示,根据里程计信息确定的多个第三车辆位姿可以采用第二轨迹
Figure PCTCN2019113487-appb-000019
表示。求解
Figure PCTCN2019113487-appb-000020
公式,可以理解为确定将第一轨迹变换至第二轨迹时的最小变换量。计算trace init和trace odom中每一项的残差大小,即计算
Figure PCTCN2019113487-appb-000021
可以得到两个轨迹的匹配程度,当该匹配程度大于预设匹配度阈值时,确定初始化定位成功。
In the initial recognition area, the second vehicle pose determined from multiple parking lot image frames can adopt the first trajectory
Figure PCTCN2019113487-appb-000017
Figure PCTCN2019113487-appb-000018
Indicates that multiple third vehicle poses determined according to the odometer information can adopt the second trajectory
Figure PCTCN2019113487-appb-000019
Said. Solve
Figure PCTCN2019113487-appb-000020
The formula can be understood as determining the minimum amount of change when changing the first trajectory to the second trajectory. Calculate the residual size of each item in trace init and trace odom , that is, calculate
Figure PCTCN2019113487-appb-000021
The matching degree of the two trajectories can be obtained, and when the matching degree is greater than the preset matching degree threshold, it is determined that the initial positioning is successful.
图5为本发明实施例提供的一种泊车定位中的停车场入口定位装置的结构示意图。该装置应用于电子设备。该电子设备可以为普通计算机、服务器或者智能终端设备等,也可以为安装于车辆中的车载终端。该装置实施例与图1所示方法实施例相对应。该装置包括以下模块。FIG. 5 is a schematic structural diagram of a parking lot entrance positioning device in parking positioning according to an embodiment of the present invention. The device is applied to electronic equipment. The electronic device may be an ordinary computer, a server, or an intelligent terminal device, etc., or may be a vehicle-mounted terminal installed in the vehicle. This device embodiment corresponds to the method embodiment shown in FIG. 1. The device includes the following modules.
判断模块510,被配置为当检测到车辆驶入停车场入口处时,获取定位模块确定的初始车辆位姿,判断初始车辆位姿指示的位置是否处于预设的初始化识别区域中;The judging module 510 is configured to obtain the initial vehicle pose determined by the positioning module when it is detected that the vehicle has entered the entrance of the parking lot, and judge whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
获取模块520,被配置为当初始车辆位姿指示的位置处于预设的初始化识别区域中时,获取相机模块采集的停车场图像;其中,停车场图像为在初始化识别区域中采集的图像;The acquiring module 520 is configured to acquire the parking lot image collected by the camera module when the position indicated by the initial vehicle pose is in the preset initial recognition area; wherein the parking lot image is an image acquired in the initial recognition area;
检测模块530,被配置为检测停车场图像的语义信息;其中,语义信息为用于标识车辆周围的标志物的信息;The detection module 530 is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
第一确定模块540,被配置为基于停车场图像的语义信息和初始车辆位姿,通过位姿回归模型确定车辆的第一车辆位姿;其中,位姿回归模型为预先根据在初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;The first determining module 540 is configured to determine the first vehicle pose of the vehicle through the pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is based on the initial recognition area The collected multiple sample parking lot images and the corresponding sample initial vehicle pose and the marked vehicle pose are trained;
第二确定模块550,被配置为根据第一车辆位姿,匹配停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定车辆的第二车辆位姿。The second determining module 550 is configured to match the semantic information of the parking lot image with the semantic information of each location point in the preset map according to the first vehicle pose, and determine the second vehicle pose of the vehicle according to the matching result.
在本发明的另一实施例中,基于图5所示实施例,该装置还可以包括训练模块(图中未示出);训练模块,被配置为采用以下操作训练得到位姿回归模型:In another embodiment of the present invention, based on the embodiment shown in FIG. 5, the device may further include a training module (not shown in the figure); the training module is configured to train the pose regression model by using the following operations:
获取在初始化识别区域内采集的多个样本停车场图像,以及每个样本停车场图像对应的样本初始车辆位姿和标注的车辆位姿;Acquire multiple sample parking lot images collected in the initial recognition area, as well as the sample initial vehicle pose and the marked vehicle pose corresponding to each sample parking lot image;
检测每个样本停车场图像的样本语义信息;Detect the sample semantic information of each sample parking lot image;
基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车 辆位姿;Based on the semantic information of each sample and the corresponding sample initial vehicle pose, the reference vehicle pose is determined through the model parameters in the pose regression model;
确定参考车辆位姿与标注的车辆位姿之间的差异量;Determine the amount of difference between the reference vehicle pose and the marked vehicle pose;
当差异量大于预设差异量阈值时,修正模型参数,返回执行基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿的操作;When the difference amount is greater than the preset difference amount threshold, modify the model parameters, return to execute the operation of determining the reference vehicle pose based on the semantic information of each sample and the corresponding sample initial vehicle pose, and determine the reference vehicle pose based on the model parameters in the pose regression model;
当差异量不大于预设差异量阈值时,确定位姿回归模型训练完成。When the difference amount is not greater than the preset difference amount threshold, it is determined that the pose regression model training is completed.
在本发明的另一实施例中,基于图5所示实施例,第二确定模块550具体被配置为:In another embodiment of the present invention, based on the embodiment shown in FIG. 5, the second determining module 550 is specifically configured to:
匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,得到匹配成功的语义信息在所述预设地图中对应的目标位置;Matching the semantic information of the parking lot image with the semantic information of each location point in the preset map to obtain the target location corresponding to the successfully matched semantic information in the preset map;
采用以下迭代操作中的一种确定所述车辆的第二车辆位姿;Use one of the following iterative operations to determine the second vehicle pose of the vehicle;
以第一车辆位姿作为估计位姿的初始取值,根据估计位姿的取值以及所述停车场图像的语义信息在停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;Taking the first vehicle pose as the initial value of the estimated pose, and according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image, the semantic information of the parking lot image is mapped to The first mapping position in the preset map;
确定第一映射位置与目标位置之间的第一误差;Determine the first error between the first mapping position and the target position;
当第一误差大于预设误差阈值时,调整估计位姿的取值,并返回执行根据估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算停车场图像的语义信息映射至预设地图中的第一映射位置;When the first error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation of parking based on the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image The semantic information of the field image is mapped to the first mapping position in the preset map;
当第一误差不大于预设误差阈值时,根据估计位姿的当前取值确定车辆的第二车辆位姿;When the first error is not greater than the preset error threshold, determine the second vehicle pose of the vehicle according to the current value of the estimated pose;
或者,or,
以第一车辆位姿作为估计位姿的初始取值,根据估计位姿的取值以及目标位置,计算预设地图中匹配成功的语义信息在停车场图像中的第二映射位置;Use the first vehicle pose as the initial value of the estimated pose, and calculate the second mapping position in the parking lot image of the semantic information successfully matched in the preset map according to the estimated pose value and the target position;
确定第二映射位置与停车场图像的语义信息在停车场图像中的位置之间的第二误差;Determine the second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image;
当第二误差大于预设误差阈值时,调整估计位姿的取值,并返回执行根据估计位姿的取值以及目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置;When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation based on the value of the estimated pose and the target position to calculate the semantic information that is successfully matched in the preset map in the parking lot. The second mapping position in the image;
当所述第二误差不大于预设误差阈值时,根据估计位姿的当前取值确定车辆的第二车辆位姿。When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
在本发明的另一实施例中,基于图5所示实施例,该装置还可以包括验证模块(图中未示出);该验证模块,被配置为采用以下操作验证停车场入口定位是否成功:In another embodiment of the present invention, based on the embodiment shown in FIG. 5, the device may further include a verification module (not shown in the figure); the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful :
在确定车辆的第二车辆位姿之后,获取当定位模块确定的多个初始车辆位姿指示的位置处于初始化识别区域时,多个停车场图像帧对应的车辆的第二车辆位姿;After determining the second vehicle pose of the vehicle, obtain the second vehicle pose of the vehicle corresponding to the multiple parking lot image frames when the position indicated by the multiple initial vehicle poses determined by the positioning module is in the initialization recognition area;
获取根据里程计采集的里程计信息确定的多个第三车辆位姿;Acquire multiple third vehicle poses determined according to the odometer information collected by the odometer;
确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
当残差小于预设残差阈值时,确定车辆在停车场入口定位成功,以多个第二车辆位姿作为车辆在停车场入口的成功定位信息。When the residual is less than the preset residual threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and multiple second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
在本发明的另一实施例中,基于上述所示实施例,验证模块,在确定多个第二车辆位姿和多个第三车辆位姿之间的残差时,包括:In another embodiment of the present invention, based on the embodiment shown above, the verification module, when determining the residuals between the multiple second vehicle poses and the multiple third vehicle poses, includes:
通过最小二乘法求解以下函数,得到多个第二车辆位姿和多个第三车辆位姿之间的刚性变换矩阵T:Solve the following function by the least square method to obtain the rigid transformation matrix T between multiple second vehicle poses and multiple third vehicle poses:
Figure PCTCN2019113487-appb-000022
Figure PCTCN2019113487-appb-000022
将求解得到的T代入
Figure PCTCN2019113487-appb-000023
得到多个第二车辆位姿和多个第三车辆位姿之间残差;
Substitute the obtained T into
Figure PCTCN2019113487-appb-000023
Obtain residuals between multiple second vehicle poses and multiple third vehicle poses;
其中,
Figure PCTCN2019113487-appb-000024
为第i个第二车辆位姿,
Figure PCTCN2019113487-appb-000025
为第i个第三车辆位姿,N为第二车辆位姿或第三车辆位姿的总数量,min为求最小值函数,‖·‖为范数符号。
among them,
Figure PCTCN2019113487-appb-000024
Is the i-th second vehicle pose,
Figure PCTCN2019113487-appb-000025
Is the i-th third vehicle pose, N is the total number of the second vehicle pose or the third vehicle pose, min is the minimum function, and ‖·‖ is the norm symbol.
在本发明的另一实施例中,基于图5所示实施例,检测模块530具体被配置为:In another embodiment of the present invention, based on the embodiment shown in FIG. 5, the detection module 530 is specifically configured to:
将停车场图像转换至俯视图坐标系下,得到地面图像;Convert the parking lot image to the top view coordinate system to obtain the ground image;
对地面图像进行二值化处理,得到处理后图像;Binarize the ground image to obtain the processed image;
根据处理后图像中的信息,确定停车场图像的语义信息。According to the information in the processed image, the semantic information of the parking lot image is determined.
上述装置实施例与方法实施例相对应,与该方法实施例具有同样的技术效果,具体说明参见方法实施例。装置实施例是基于方法实施例得到的,具体的说明可以参见方法实施例部分,此处不再赘述。The foregoing device embodiment corresponds to the method embodiment, and has the same technical effect as the method embodiment. For specific description, refer to the method embodiment. The device embodiment is obtained based on the method embodiment, and the specific description can be found in the method embodiment part, which will not be repeated here.
图6为本发明实施例提供的一种车载终端的结构示意图。该车载终端包括:处理器610、图像采集设备620和定位设备630。其中,处理器包括:判断模块、获取模块、检测模块、第一确定模块和第二确定模块(图中未示出)。Fig. 6 is a schematic structural diagram of a vehicle-mounted terminal provided by an embodiment of the present invention. The vehicle-mounted terminal includes a processor 610, an image acquisition device 620, and a positioning device 630. Wherein, the processor includes: a judgment module, an acquisition module, a detection module, a first determination module, and a second determination module (not shown in the figure).
判断模块,被配置为当检测到车辆驶入停车场入口处时,获取定位设备630确定的初始车辆位姿,判断初始车辆位姿指示的位置是否处于预设的初始化识别区域中;The judging module is configured to obtain the initial vehicle pose determined by the positioning device 630 when it is detected that the vehicle has entered the entrance of the parking lot, and determine whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
获取模块,被配置为当初始车辆位姿指示的位置处于预设的初始化识别区域中时,获取图像采集设备620采集的停车场图像;其中,停车场图像为在初始化识别区域中采集的图像;The acquiring module is configured to acquire the parking lot image collected by the image acquisition device 620 when the position indicated by the initial vehicle pose is in the preset initial recognition area; wherein, the parking lot image is an image acquired in the initial recognition area;
检测模块,被配置为检测停车场图像的语义信息;其中,语义信息为用于标识车辆周围的标志物的信息;The detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
第一确定模块,被配置为基于停车场图像的语义信息和初始车辆位姿,通过位姿回归模型确定车辆的第一车辆位姿;其中,位姿回归模型为预先根据在初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;The first determination module is configured to determine the first vehicle pose of the vehicle through the pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is based on pre-collecting in the initialization recognition area Multiple sample parking lot images and corresponding sample initial vehicle poses and labeled vehicle poses are trained;
第二确定模块,被配置为根据第一车辆位姿,匹配停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定车辆的第二车辆位姿。The second determining module is configured to match the semantic information of the parking lot image with the semantic information of each location point in the preset map according to the first vehicle pose, and determine the second vehicle pose of the vehicle according to the matching result.
在本发明的另一实施例中,基于图6所示实施例,处理器610还包括训练模块(图中未示出);训练模块,被配置为采用以下操作训练得到位姿回归模型:In another embodiment of the present invention, based on the embodiment shown in FIG. 6, the processor 610 further includes a training module (not shown in the figure); the training module is configured to use the following operations to train to obtain the pose regression model:
获取在初始化识别区域内采集的多个样本停车场图像,以及每个样本停车场图像对应的样本初始车辆位姿和标注的车辆位姿;Acquire multiple sample parking lot images collected in the initial recognition area, as well as the sample initial vehicle pose and the marked vehicle pose corresponding to each sample parking lot image;
检测每个样本停车场图像的样本语义信息;Detect the sample semantic information of each sample parking lot image;
基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿;Based on the semantic information of each sample and the corresponding initial vehicle pose, the reference vehicle pose is determined through the model parameters in the pose regression model;
确定参考车辆位姿与标注的车辆位姿之间的差异量;Determine the amount of difference between the reference vehicle pose and the marked vehicle pose;
当差异量大于预设差异量阈值时,修正模型参数,返回执行基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿的操作;When the difference amount is greater than the preset difference amount threshold, modify the model parameters, return to execute the operation of determining the reference vehicle pose based on the semantic information of each sample and the corresponding sample initial vehicle pose, and determine the reference vehicle pose based on the model parameters in the pose regression model;
当差异量不大于预设差异量阈值时,确定位姿回归模型训练完成。When the difference amount is not greater than the preset difference amount threshold, it is determined that the pose regression model training is completed.
在本发明的另一实施例中,基于图6所示实施例,第二确定模块具体被配置为:In another embodiment of the present invention, based on the embodiment shown in FIG. 6, the second determining module is specifically configured as:
匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,得到匹配成功的语义信息在所述预设地图中对应的目标位置;Matching the semantic information of the parking lot image with the semantic information of each location point in the preset map to obtain the target location corresponding to the successfully matched semantic information in the preset map;
采用以下迭代操作中的一种确定所述车辆的第二车辆位姿;Use one of the following iterative operations to determine the second vehicle pose of the vehicle;
以第一车辆位姿作为估计位姿的初始取值,根据估计位姿的取值以及所述停车场图像的语义信息在停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;Taking the first vehicle pose as the initial value of the estimated pose, and according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image, the semantic information of the parking lot image is mapped to The first mapping position in the preset map;
确定第一映射位置与目标位置之间的第一误差;Determine the first error between the first mapping position and the target position;
当第一误差大于预设误差阈值时,调整估计位姿的取值,并返回执行根据估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算停车场图像的语义信息映射至预设地图中的第一映射位置;When the first error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation of parking based on the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image The semantic information of the field image is mapped to the first mapping position in the preset map;
当第一误差不大于预设误差阈值时,根据估计位姿的当前取值确定车辆的第二车辆位姿;When the first error is not greater than the preset error threshold, determine the second vehicle pose of the vehicle according to the current value of the estimated pose;
或者,or,
以第一车辆位姿作为估计位姿的初始取值,根据估计位姿的取值以及目标位置,计算预设地图中匹配成功的语义信息在停车场图像中的第二映射位置;Use the first vehicle pose as the initial value of the estimated pose, and calculate the second mapping position in the parking lot image of the semantic information successfully matched in the preset map according to the estimated pose value and the target position;
确定第二映射位置与停车场图像的语义信息在停车场图像中的位置之间的第二误差;Determine the second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image;
当第二误差大于预设误差阈值时,调整估计位姿的取值,并返回执行根据估计位姿的取值以及目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置;When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation based on the value of the estimated pose and the target position to calculate the semantic information that is successfully matched in the preset map in the parking lot. The second mapping position in the image;
当所述第二误差不大于预设误差阈值时,根据估计位姿的当前取值确定车辆的第二车辆位姿。When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
在本发明的另一实施例中,基于图6所示实施例,处理器610还可以包括验证模块(图中未示出);验证模块,被配置为采用以下操作验证停车场入口定位是否成功:In another embodiment of the present invention, based on the embodiment shown in FIG. 6, the processor 610 may also include a verification module (not shown in the figure); the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful :
在确定车辆的第二车辆位姿之后,获取当定位设备630确定的多个初始车辆位姿指示的位置处于初始化识别区域时,多个停车场图像帧对应的车辆的第二车辆位姿;After determining the second vehicle pose of the vehicle, obtain the second vehicle pose of the vehicle corresponding to the multiple parking lot image frames when the position indicated by the multiple initial vehicle poses determined by the positioning device 630 is in the initialization recognition area;
获取根据里程计采集的里程计信息确定的多个第三车辆位姿;Acquire multiple third vehicle poses determined according to the odometer information collected by the odometer;
确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
当残差小于预设残差阈值时,确定车辆在停车场入口定位成功,以多个第二车辆位姿作为车辆在停车场入口的成功定位信息。When the residual is less than the preset residual threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and multiple second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
在本发明的另一实施例中,基于图6所示实施例,验证模块,确定多个第二车辆位姿和多个第三车辆位姿之间的残差时,包括:In another embodiment of the present invention, based on the embodiment shown in FIG. 6, when the verification module determines the residuals between the multiple second vehicle poses and the multiple third vehicle poses, it includes:
通过最小二乘法求解以下函数,得到多个第二车辆位姿和多个第三车辆位姿之间的刚性变换矩阵T:Solve the following function by the least square method to obtain the rigid transformation matrix T between multiple second vehicle poses and multiple third vehicle poses:
Figure PCTCN2019113487-appb-000026
Figure PCTCN2019113487-appb-000026
将求解得到的T代入
Figure PCTCN2019113487-appb-000027
得到多个第二车辆位姿和多个第三车辆位姿之间残差;
Substitute the obtained T into
Figure PCTCN2019113487-appb-000027
Obtain residuals between multiple second vehicle poses and multiple third vehicle poses;
其中,
Figure PCTCN2019113487-appb-000028
为第i个第二车辆位姿,
Figure PCTCN2019113487-appb-000029
为第i个第三车辆位姿,N为第二车辆位姿或第三车辆位姿的总数量,min为求最小值函数,‖·‖为范数符号。
among them,
Figure PCTCN2019113487-appb-000028
Is the i-th second vehicle pose,
Figure PCTCN2019113487-appb-000029
Is the i-th third vehicle pose, N is the total number of the second vehicle pose or the third vehicle pose, min is the minimum function, and ‖·‖ is the norm symbol.
在本发明的另一实施例中,基于图6所示实施例,检测模块具体被配置为:In another embodiment of the present invention, based on the embodiment shown in FIG. 6, the detection module is specifically configured as:
将停车场图像转换至俯视图坐标系下,得到地面图像;Convert the parking lot image to the top view coordinate system to obtain the ground image;
对地面图像进行二值化处理,得到处理后图像;Binarize the ground image to obtain the processed image;
根据处理后图像中的信息,确定停车场图像的语义信息。According to the information in the processed image, the semantic information of the parking lot image is determined.
该终端实施例与图1所示方法实施例是基于同一发明构思得到的实施例,相关之处可以相互参照。上述终端实施例与方法实施例相对应,与该方法实施例具有同样的技术效果,具体说明参见方法实施例。This embodiment of the terminal and the embodiment of the method shown in FIG. 1 are embodiments based on the same inventive concept, and relevant points may be referred to each other. The foregoing terminal embodiment corresponds to the method embodiment, and has the same technical effect as the method embodiment. For specific description, refer to the method embodiment.
本领域普通技术人员可以理解:附图只是一个实施例的示意图,附图中的模块或流程并不一定是实施本发明所必须的。A person of ordinary skill in the art can understand that the drawings are only schematic diagrams of an embodiment, and the modules or processes in the drawings are not necessarily necessary for implementing the present invention.
本领域普通技术人员可以理解:实施例中的装置中的模块可以按照实施例描述分布于实施例的装置中,也可以进行相应变化位于不同于本实施例的一个或多个装置中。上述实施例的模块可以合并为一个模块,也可以进一步拆分成多个子模块。A person of ordinary skill in the art can understand that the modules in the device in the embodiment may be distributed in the device in the embodiment according to the description of the embodiment, or may be located in one or more devices different from this embodiment with corresponding changes. The modules of the above-mentioned embodiments can be combined into one module or further divided into multiple sub-modules.
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的精神和范围。Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: The technical solutions recorded in the foregoing embodiments are modified, or some of the technical features are equivalently replaced; these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of the embodiments of the present invention.

Claims (10)

  1. 一种泊车定位中的停车场入口定位方法,其特征在于,包括:A parking lot entrance location method in parking location, which is characterized in that it comprises:
    当检测到车辆驶入停车场入口处时,获取定位模块确定的初始车辆位姿,判断所述初始车辆位姿指示的位置是否处于预设的初始化识别区域中;When it is detected that the vehicle has entered the entrance of the parking lot, acquiring the initial vehicle pose determined by the positioning module, and determining whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
    如果处于,则获取相机模块采集的停车场图像;其中,所述停车场图像为在所述初始化识别区域中采集的图像;If it is, acquire a parking lot image collected by the camera module; wherein the parking lot image is an image collected in the initial recognition area;
    检测所述停车场图像的语义信息;其中,所述语义信息为用于标识车辆周围的标志物的信息;Detecting semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
    基于所述停车场图像的语义信息和所述初始车辆位姿,通过位姿回归模型确定所述车辆的第一车辆位姿;其中,所述位姿回归模型为预先根据在所述初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;Based on the semantic information of the parking lot image and the initial vehicle pose, the first vehicle pose of the vehicle is determined by a pose regression model; wherein, the pose regression model is based on the initial recognition area A number of sample parking lot images collected inside and the corresponding sample initial vehicle pose and labeled vehicle pose are trained;
    根据所述第一车辆位姿,匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿。According to the first vehicle pose, the semantic information of the parking lot image is matched with the semantic information of each location point in the preset map, and the second vehicle pose of the vehicle is determined according to the matching result.
  2. 如权利要求1所述的方法,其特征在于,所述位姿回归模型采用以下方式训练得到:The method of claim 1, wherein the pose regression model is trained in the following manner:
    获取在所述初始化识别区域内采集的多个样本停车场图像,以及每个样本停车场图像对应的样本初始车辆位姿和标注的车辆位姿;Acquiring a plurality of sample parking lot images collected in the initial recognition area, and a sample initial vehicle pose and a marked vehicle pose corresponding to each sample parking lot image;
    检测每个样本停车场图像的样本语义信息;Detect the sample semantic information of each sample parking lot image;
    基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿;Based on the semantic information of each sample and the corresponding initial vehicle pose, the reference vehicle pose is determined through the model parameters in the pose regression model;
    确定所述参考车辆位姿与所述标注的车辆位姿之间的差异量;Determining the amount of difference between the reference vehicle pose and the marked vehicle pose;
    当所述差异量大于预设差异量阈值时,修正所述模型参数,返回执行所述基于每个样本语义信息和对应的样本初始车辆位姿,通过位姿回归模型中的模型参数确定参考车辆位姿的步骤;When the difference amount is greater than the preset difference amount threshold, modify the model parameters, return to execute the initial vehicle pose based on the semantic information of each sample and the corresponding sample, and determine the reference vehicle based on the model parameters in the pose regression model Posture steps
    当所述差异量不大于所述预设差异量阈值时,确定所述位姿回归模型训练完成。When the difference amount is not greater than the preset difference amount threshold, it is determined that the training of the pose regression model is completed.
  3. 如权利要求1所述的方法,其特征在于,所述根据所述第一车辆位姿,匹配所述停车场图像的语义信息与所述预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿的步骤,包括:The method according to claim 1, wherein the matching semantic information of the parking lot image with the semantic information of each location point in the preset map according to the first vehicle pose, according to the matching result The step of determining the second vehicle pose of the vehicle includes:
    匹配所述停车场图像的语义信息与所述预设地图中各个位置点的语义信息,得到匹配成功的语义信息在所述预设地图中对应的目标位置;Matching the semantic information of the parking lot image with the semantic information of each location point in the preset map to obtain the target location corresponding to the successfully matched semantic information in the preset map;
    采用以下迭代方式中的一种确定所述车辆的第二车辆位姿;Use one of the following iterative methods to determine the second vehicle pose of the vehicle;
    以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置;The first vehicle pose is used as the initial value of the estimated pose, and the parking lot is calculated according to the value of the estimated pose and the position of the semantic information of the parking lot image in the parking lot image The semantic information of the image is mapped to the first mapping position in the preset map;
    确定所述第一映射位置与所述目标位置之间的第一误差;Determining a first error between the first mapping position and the target position;
    当所述第一误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行所述根据所述估计位姿的取值以及所述停车场图像的语义信息在所述停车场图像中的位置,计算所述停车场图像的语义信息映射至所述预设地图中的第一映射位置的步骤;When the first error is greater than a preset error threshold, the value of the estimated pose is adjusted, and the execution of the value of the estimated pose and the semantic information of the parking lot image is performed in the parking lot. The position in the field image, the step of calculating the semantic information of the parking lot image to be mapped to the first mapping position in the preset map;
    当所述第一误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿;When the first error is not greater than the preset error threshold, determine the second vehicle pose of the vehicle according to the current value of the estimated pose;
    或者,or,
    以所述第一车辆位姿作为估计位姿的初始取值,根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置;Taking the first vehicle pose as the initial value of the estimated pose, and according to the value of the estimated pose and the target position, calculate the semantic information that is successfully matched in the preset map in the parking lot image The second mapping position in;
    确定所述第二映射位置与所述停车场图像的语义信息在所述停车场图像中的位置之间的第二误差;Determining a second error between the second mapping position and the position of the semantic information of the parking lot image in the parking lot image;
    当所述第二误差大于预设误差阈值时,调整所述估计位姿的取值,并返回执行所述根据所述估计位姿的取值以及所述目标位置,计算所述预设地图中匹配成功的语义信息在所述停车场图像中的第二映射位置的步骤;When the second error is greater than the preset error threshold, adjust the value of the estimated pose, and return to execute the calculation of the preset map based on the value of the estimated pose and the target position The step of matching the second mapping position of the successfully matched semantic information in the parking lot image;
    当所述第二误差不大于所述预设误差阈值时,根据所述估计位姿的当前取值确定所述车辆的第二车辆位姿。When the second error is not greater than the preset error threshold, the second vehicle pose of the vehicle is determined according to the current value of the estimated pose.
  4. 如权利要求1所述的方法,其特征在于,在确定所述车辆的第二车辆位姿之后,采用以下方式验证停车场入口定位是否成功:The method of claim 1, wherein after determining the second vehicle pose of the vehicle, the following methods are used to verify whether the parking lot entrance location is successful:
    获取当所述定位模块确定的多个初始车辆位姿指示的位置处于所述初始化识别区域时,多个停车场图像帧对应的所述车辆的第二车辆位姿;Acquiring the second vehicle pose of the vehicle corresponding to the multiple parking lot image frames when the positions indicated by the multiple initial vehicle poses determined by the positioning module are in the initialization recognition area;
    获取根据所述里程计采集的里程计信息确定的多个第三车辆位姿;Acquiring multiple third vehicle poses determined according to the odometer information collected by the odometer;
    确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
    当所述残差小于预设残差阈值时,确定所述车辆在停车场入口定位成功,以所述多个第二车辆位姿作为所述车辆在停车场入口的成功定位信息。When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  5. 如权利要求4所述的方法,其特征在于,所述确定多个第二车辆位姿和多个第三车辆位姿之间的残差的步骤,包括:The method of claim 4, wherein the step of determining the residuals between the plurality of second vehicle poses and the plurality of third vehicle poses comprises:
    通过最小二乘法求解以下函数,得到多个第二车辆位姿和多个第三车辆位姿之间的刚性变换矩阵T:Solve the following function by the least square method to obtain the rigid transformation matrix T between multiple second vehicle poses and multiple third vehicle poses:
    Figure PCTCN2019113487-appb-100001
    Figure PCTCN2019113487-appb-100001
    将求解得到的所述T代入
    Figure PCTCN2019113487-appb-100002
    得到多个第二车辆位姿和多个第三车辆位姿之间残差;
    Substitute the T obtained by the solution into
    Figure PCTCN2019113487-appb-100002
    Obtain residuals between multiple second vehicle poses and multiple third vehicle poses;
    其中,所述
    Figure PCTCN2019113487-appb-100003
    为第i个第二车辆位姿,所述
    Figure PCTCN2019113487-appb-100004
    为第i个第三车辆位姿,所述N为所述第二车辆位姿或第三车辆位姿的总数量,所述min为求最小值函数,所述‖·‖为范数符号。
    Among them, the
    Figure PCTCN2019113487-appb-100003
    Is the i-th second vehicle pose, the
    Figure PCTCN2019113487-appb-100004
    Is the i-th third vehicle pose, the N is the total number of the second vehicle pose or the third vehicle pose, the min is the minimum value function, and the ‖·‖ is the norm symbol.
  6. 如权利要求1所述的方法,其特征在于,所述检测所述停车场图像的语义信息的步骤,包括:The method of claim 1, wherein the step of detecting the semantic information of the parking lot image comprises:
    将所述停车场图像转换至俯视图坐标系下,得到地面图像;Convert the parking lot image to the top view coordinate system to obtain a ground image;
    对所述地面图像进行二值化处理,得到处理后图像;Binarize the ground image to obtain a processed image;
    根据所述处理后图像中的信息,确定所述停车场图像的语义信息。Determine the semantic information of the parking lot image according to the information in the processed image.
  7. 一种泊车定位中的停车场入口定位装置,其特征在于,包括:A parking lot entrance positioning device in parking positioning, characterized in that it comprises:
    判断模块,被配置为当检测到车辆驶入停车场入口处时,获取定位模块确定的初始车辆位姿,判断所述初始车辆位姿指示的位置是否处于预设的初始化识别区域中;The judgment module is configured to obtain the initial vehicle pose determined by the positioning module when it is detected that the vehicle enters the entrance of the parking lot, and judge whether the position indicated by the initial vehicle pose is in the preset initialization recognition area;
    获取模块,被配置为当所述初始车辆位姿指示的位置处于预设的初始化识别区域中时,获取相机模块采集的停车场图像;其中,所述停车场图像为在所述初始化识别区域中采集的图像;The acquiring module is configured to acquire the parking lot image collected by the camera module when the position indicated by the initial vehicle pose is in the preset initialization recognition area; wherein, the parking lot image is in the initialization recognition area Captured images;
    检测模块,被配置为检测所述停车场图像的语义信息;其中,所述语义信息为用于标识车辆周围的标志物的信息;The detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
    第一确定模块,被配置为基于所述停车场图像的语义信息和所述初始车辆位姿,通过位姿回归模型确定所述车辆的第一车辆位姿;其中,所述位姿回归模型为预先根据在所述初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;The first determining module is configured to determine the first vehicle pose of the vehicle through a pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is It is obtained by training in advance based on a plurality of sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose;
    第二确定模块,被配置为根据所述第一车辆位姿,匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿。The second determining module is configured to match the semantic information of the parking lot image with the semantic information of each position point in the preset map according to the pose of the first vehicle, and determine the second vehicle position of the vehicle according to the matching result posture.
  8. 如权利要求7所述的装置,其特征在于,所述装置还包括验证模块;所述验证模块,被配置为采用以下操作验证停车场入口定位是否成功:7. The device according to claim 7, wherein the device further comprises a verification module; the verification module is configured to verify whether the parking lot entrance location is successful or not by adopting the following operations:
    在确定所述车辆的第二车辆位姿之后,获取当所述定位模块确定的多个初始车辆位姿指示的位置 处于所述初始化识别区域时,多个停车场图像帧对应的所述车辆的第二车辆位姿;After determining the second vehicle pose of the vehicle, obtain the position of the vehicle corresponding to the multiple parking lot image frames when the position indicated by the multiple initial vehicle poses determined by the positioning module is in the initialization recognition area The second vehicle pose;
    获取根据里程计采集的里程计信息确定的多个第三车辆位姿;Acquire multiple third vehicle poses determined according to the odometer information collected by the odometer;
    确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
    当所述残差小于预设残差阈值时,确定所述车辆在停车场入口定位成功,以所述多个第二车辆位姿作为所述车辆在停车场入口的成功定位信息。When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
  9. 一种车载终端,其特征在于,包括:处理器、图像采集设备和定位设备;其中,所述处理器包括:判断模块、获取模块、检测模块、第一确定模块和第二确定模块;A vehicle-mounted terminal, characterized by comprising: a processor, an image acquisition device, and a positioning device; wherein the processor includes: a judgment module, an acquisition module, a detection module, a first determination module, and a second determination module;
    判断模块,被配置为当检测到车辆驶入停车场入口处时,获取定位设备确定的初始车辆位姿,判断所述初始车辆位姿指示的位置是否处于预设的初始化识别区域中;The judging module is configured to obtain the initial vehicle pose determined by the positioning device when it is detected that the vehicle enters the entrance of the parking lot, and determine whether the position indicated by the initial vehicle pose is in a preset initialization recognition area;
    获取模块,被配置为当所述初始车辆位姿指示的位置处于预设的初始化识别区域中时,获取图像采集设备采集的停车场图像;其中,所述停车场图像为在所述初始化识别区域中采集的图像;The acquiring module is configured to acquire the parking lot image collected by the image acquisition device when the position indicated by the initial vehicle pose is in the preset initial recognition area; wherein, the parking lot image is in the initial recognition area Images collected in
    检测模块,被配置为检测所述停车场图像的语义信息;其中,所述语义信息为用于标识车辆周围的标志物的信息;The detection module is configured to detect semantic information of the parking lot image; wherein the semantic information is information used to identify landmarks around the vehicle;
    第一确定模块,被配置为基于所述停车场图像的语义信息和所述初始车辆位姿,通过位姿回归模型确定所述车辆的第一车辆位姿;其中,所述位姿回归模型为预先根据在所述初始化识别区域内采集的多个样本停车场图像以及对应的样本初始车辆位姿和标注的车辆位姿训练得到;The first determining module is configured to determine the first vehicle pose of the vehicle through a pose regression model based on the semantic information of the parking lot image and the initial vehicle pose; wherein, the pose regression model is It is obtained by training in advance based on a plurality of sample parking lot images collected in the initial recognition area and the corresponding sample initial vehicle pose and the marked vehicle pose;
    第二确定模块,被配置为根据所述第一车辆位姿,匹配所述停车场图像的语义信息与预设地图中各个位置点的语义信息,根据匹配结果确定所述车辆的第二车辆位姿。The second determining module is configured to match the semantic information of the parking lot image with the semantic information of each position point in the preset map according to the pose of the first vehicle, and determine the second vehicle position of the vehicle according to the matching result posture.
  10. 如权利要求9所述的终端,其特征在于,所述处理器还包括验证模块;所述验证模块,被配置为采用以下操作验证停车场入口定位是否成功:The terminal according to claim 9, wherein the processor further comprises a verification module; the verification module is configured to use the following operations to verify whether the parking lot entrance location is successful:
    在确定所述车辆的第二车辆位姿之后,获取当所述定位设备确定的多个初始车辆位姿指示的位置处于所述初始化识别区域时,多个停车场图像帧对应的所述车辆的第二车辆位姿;After determining the second vehicle pose of the vehicle, obtain the position of the vehicle corresponding to the multiple parking lot image frames when the position indicated by the multiple initial vehicle poses determined by the positioning device is in the initialization recognition area The second vehicle pose;
    获取根据里程计采集的里程计信息确定的多个第三车辆位姿;Acquire multiple third vehicle poses determined according to the odometer information collected by the odometer;
    确定多个第二车辆位姿和多个第三车辆位姿之间的残差;Determine residuals between multiple second vehicle poses and multiple third vehicle poses;
    当所述残差小于预设残差阈值时,确定所述车辆在停车场入口定位成功,以所述多个第二车辆位姿作为所述车辆在停车场入口的成功定位信息。When the residual error is less than the preset residual error threshold, it is determined that the vehicle is successfully positioned at the entrance of the parking lot, and the plurality of second vehicle poses are used as the successful positioning information of the vehicle at the entrance of the parking lot.
PCT/CN2019/113487 2019-06-17 2019-10-26 Method and apparatus for positioning parking entrance in parking positioning, and vehicle-mounted terminal WO2020253010A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201910522591.1 2019-06-17
CN201910522591.1A CN112102646B (en) 2019-06-17 2019-06-17 Parking lot entrance positioning method and device in parking positioning and vehicle-mounted terminal

Publications (1)

Publication Number Publication Date
WO2020253010A1 true WO2020253010A1 (en) 2020-12-24

Family

ID=73749018

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/113487 WO2020253010A1 (en) 2019-06-17 2019-10-26 Method and apparatus for positioning parking entrance in parking positioning, and vehicle-mounted terminal

Country Status (2)

Country Link
CN (1) CN112102646B (en)
WO (1) WO2020253010A1 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112819892A (en) * 2021-02-08 2021-05-18 北京航空航天大学 Image processing method and device
CN113465620A (en) * 2021-06-02 2021-10-01 上海追势科技有限公司 Parking lot particle filter positioning method based on semantic information
CN113591865A (en) * 2021-07-28 2021-11-02 深圳甲壳虫智能有限公司 Loop detection method and device and electronic equipment
CN114867000A (en) * 2022-04-25 2022-08-05 惠州华阳通用电子有限公司 Emergency rescue information transmission method and device
CN114913491A (en) * 2021-02-08 2022-08-16 广州汽车集团股份有限公司 Vehicle positioning method and system and computer readable storage medium
CN115273028A (en) * 2022-07-14 2022-11-01 清华大学 Intelligent parking lot semantic map construction method and system based on global perception
CN115686029A (en) * 2023-01-05 2023-02-03 北京易控智驾科技有限公司 Unmanned operation method and device based on manned driving, electronic equipment and storage medium

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102021117744A1 (en) 2021-07-09 2023-01-12 Cariad Se Self localization of a vehicle based on an initial pose
CN113781300B (en) * 2021-08-17 2023-10-13 东风汽车集团股份有限公司 Vehicle vision positioning method for long-distance autonomous parking
CN113865602A (en) * 2021-08-18 2021-12-31 西人马帝言(北京)科技有限公司 Vehicle positioning method, device, equipment and storage medium
CN114111774B (en) * 2021-12-06 2024-04-16 纵目科技(上海)股份有限公司 Vehicle positioning method, system, equipment and computer readable storage medium
CN117115220B (en) * 2023-08-31 2024-04-26 阿里巴巴达摩院(杭州)科技有限公司 Image processing method, service providing method, device, equipment and storage medium

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103465906A (en) * 2013-08-27 2013-12-25 东莞中国科学院云计算产业技术创新与育成中心 Parking lot automatic parking implementation method based on immediacy sense
US20150279182A1 (en) * 2014-04-01 2015-10-01 Objectvideo, Inc. Complex event recognition in a sensor network
CN106485797A (en) * 2016-09-30 2017-03-08 广东中星微电子有限公司 Parking timing method and time parking devices
CN106601020A (en) * 2016-12-20 2017-04-26 纳恩博(北京)科技有限公司 Parking management robot, parking management method and system
CN108961811A (en) * 2017-05-25 2018-12-07 纵目科技(上海)股份有限公司 Parking lot vehicle positioning method, system, mobile terminal and storage medium
CN109637177A (en) * 2018-12-19 2019-04-16 斑马网络技术有限公司 Vehicle positioning method, device, equipment and storage medium

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9677887B2 (en) * 2013-03-22 2017-06-13 Qualcomm Incorporated Estimating an initial position and navigation state using vehicle odometry
CN104260722B (en) * 2014-09-23 2017-06-06 北京理工大学 A kind of automated parking system
CN106802954B (en) * 2017-01-18 2021-03-26 中国科学院合肥物质科学研究院 Unmanned vehicle semantic map model construction method and application method thereof on unmanned vehicle
CN106959691B (en) * 2017-03-24 2020-07-24 联想(北京)有限公司 Mobile electronic equipment and instant positioning and map construction method
CN108226938B (en) * 2017-12-08 2021-09-21 华南理工大学 AGV trolley positioning system and method
CN108413971B (en) * 2017-12-29 2021-12-14 驭势科技(北京)有限公司 Vehicle positioning technology based on lane line and application
CN109579844B (en) * 2018-12-04 2023-11-21 电子科技大学 Positioning method and system
CN109598339A (en) * 2018-12-07 2019-04-09 电子科技大学 A kind of vehicle attitude detection method based on grid convolutional network
CN109871024A (en) * 2019-01-04 2019-06-11 中国计量大学 A kind of UAV position and orientation estimation method based on lightweight visual odometry

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103465906A (en) * 2013-08-27 2013-12-25 东莞中国科学院云计算产业技术创新与育成中心 Parking lot automatic parking implementation method based on immediacy sense
US20150279182A1 (en) * 2014-04-01 2015-10-01 Objectvideo, Inc. Complex event recognition in a sensor network
CN106485797A (en) * 2016-09-30 2017-03-08 广东中星微电子有限公司 Parking timing method and time parking devices
CN106601020A (en) * 2016-12-20 2017-04-26 纳恩博(北京)科技有限公司 Parking management robot, parking management method and system
CN108961811A (en) * 2017-05-25 2018-12-07 纵目科技(上海)股份有限公司 Parking lot vehicle positioning method, system, mobile terminal and storage medium
CN109637177A (en) * 2018-12-19 2019-04-16 斑马网络技术有限公司 Vehicle positioning method, device, equipment and storage medium

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112819892A (en) * 2021-02-08 2021-05-18 北京航空航天大学 Image processing method and device
CN114913491A (en) * 2021-02-08 2022-08-16 广州汽车集团股份有限公司 Vehicle positioning method and system and computer readable storage medium
CN112819892B (en) * 2021-02-08 2022-11-25 北京航空航天大学 Image processing method and device
CN113465620A (en) * 2021-06-02 2021-10-01 上海追势科技有限公司 Parking lot particle filter positioning method based on semantic information
CN113591865A (en) * 2021-07-28 2021-11-02 深圳甲壳虫智能有限公司 Loop detection method and device and electronic equipment
CN113591865B (en) * 2021-07-28 2024-03-26 深圳甲壳虫智能有限公司 Loop detection method and device and electronic equipment
CN114867000A (en) * 2022-04-25 2022-08-05 惠州华阳通用电子有限公司 Emergency rescue information transmission method and device
CN114867000B (en) * 2022-04-25 2024-03-29 惠州华阳通用电子有限公司 Emergency rescue information transmission method and device
CN115273028A (en) * 2022-07-14 2022-11-01 清华大学 Intelligent parking lot semantic map construction method and system based on global perception
CN115686029A (en) * 2023-01-05 2023-02-03 北京易控智驾科技有限公司 Unmanned operation method and device based on manned driving, electronic equipment and storage medium

Also Published As

Publication number Publication date
CN112102646A (en) 2020-12-18
CN112102646B (en) 2021-12-31

Similar Documents

Publication Publication Date Title
WO2020253010A1 (en) Method and apparatus for positioning parking entrance in parking positioning, and vehicle-mounted terminal
Li et al. Springrobot: A prototype autonomous vehicle and its algorithms for lane detection
WO2021017212A1 (en) Multi-scene high-precision vehicle positioning method and apparatus, and vehicle-mounted terminal
WO2018145602A1 (en) Lane determination method, device and storage medium
CN105678689B (en) High-precision map data registration relation determining method and device
Choi et al. Environment-detection-and-mapping algorithm for autonomous driving in rural or off-road environment
Kong et al. Vanishing point detection for road detection
CN111563469A (en) Method and device for identifying irregular parking behaviors
JP2016081525A (en) Vehicular image recognition system and corresponding method
Kortli et al. A novel illumination-invariant lane detection system
CN105373135A (en) Method and system for guiding airplane docking and identifying airplane type based on machine vision
CN112307810B (en) Visual positioning effect self-checking method and vehicle-mounted terminal
CN103971081A (en) Multi-lane detection method and system
Shunsuke et al. GNSS/INS/on-board camera integration for vehicle self-localization in urban canyon
WO2021017211A1 (en) Vehicle positioning method and device employing visual sensing, and vehicle-mounted terminal
CN112927303B (en) Lane line-based automatic driving vehicle-mounted camera pose estimation method and system
CN110675341B (en) Monocular-vision-guided underwater robot and seabed platform butt joint method
CN109916415B (en) Road type determination method, device, equipment and storage medium
WO2022033484A1 (en) Garbage recognition method and system for intelligent sweeper
CN108573280B (en) Method for unmanned ship to autonomously pass through bridge
CN113256731A (en) Target detection method and device based on monocular vision
CN113011285A (en) Lane line detection method and device, automatic driving vehicle and readable storage medium
Stuebler et al. Feature-based mapping and self-localization for road vehicles using a single grayscale camera
CN112304322B (en) Restarting method after visual positioning failure and vehicle-mounted terminal
CN113780111A (en) Pipeline connector based on optimized YOLOv3 algorithm and defect accurate identification method

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: 19933421

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: 19933421

Country of ref document: EP

Kind code of ref document: A1