WO2020199564A1 - 一种导航地图在初始化时车辆位姿的修正方法和装置 - Google Patents

一种导航地图在初始化时车辆位姿的修正方法和装置 Download PDF

Info

Publication number
WO2020199564A1
WO2020199564A1 PCT/CN2019/113480 CN2019113480W WO2020199564A1 WO 2020199564 A1 WO2020199564 A1 WO 2020199564A1 CN 2019113480 W CN2019113480 W CN 2019113480W WO 2020199564 A1 WO2020199564 A1 WO 2020199564A1
Authority
WO
WIPO (PCT)
Prior art keywords
indicator
vehicle
navigation map
pose
correction
Prior art date
Application number
PCT/CN2019/113480
Other languages
English (en)
French (fr)
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 WO2020199564A1 publication Critical patent/WO2020199564A1/zh

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance

Definitions

  • the present invention relates to the technical field of automatic driving, in particular to a method and device for correcting vehicle pose when a navigation map is initialized.
  • the embodiment of the invention discloses a method and a device for correcting the vehicle pose when the navigation map is initialized, which solves the problem that unmanned vehicles use consumer-level presets in the scene of a normal road section with comprehensive traffic signs and traffic markings.
  • the problem of low positioning accuracy of the positioning device has achieved the technical effect that high-precision positioning can also be performed using a consumer-grade preset positioning device.
  • an embodiment of the present invention discloses a method for correcting the pose of a vehicle during initialization of a navigation map.
  • the method includes:
  • the navigation map and the perceived image to match other types of second indicator marks except the first indicator mark, wherein the second indicator Signs include lane lines and/or street light poles;
  • the vehicle pose after the first correction is subjected to a second correction process, so that the positions of the first indicator and the second indicator in the navigation map are The vehicle pose after the second correction processing is matched with the positions of the first indicator and the second indicator in the perception image respectively.
  • performing a first correction process on the pose of the vehicle in the navigation map based on the position of the target indicator includes:
  • a nonlinear optimization algorithm is used to perform first correction processing on the position of the vehicle’s six degrees of freedom and three degrees of freedom, so that each first indicator in the navigation map and the perception image
  • the projection error of the vehicle position on the preset standardized plane based on the first correction processing is smaller than the first preset distance.
  • determining the similarity value between the traffic signs in the navigation map after projection and the traffic signs in the perceived image after projection includes:
  • a second correction process is performed on the vehicle pose after the first correction process, so that the first indicator and the second indicator in the navigation map
  • the position of the indicator mark is matched with the position of the first indicator mark and the second indicator mark in the perception image according to the vehicle pose after the second correction processing, including:
  • the second preset distance corresponding to each of the first indicator mark and the second indicator mark is smaller than the first preset distance corresponding to each.
  • selecting a target indicator that matches each first indicator in the perception image from each first indicator of the navigation map includes:
  • each first indicator in the perceptual image compares the reconstructed first indicator with the first indicator in the navigation map for similarity, and compare the similarity value to the first set threshold.
  • the first indicator serves as the matched target indicator.
  • selecting a target indicator that matches each first indicator in the perception image from each first indicator of the navigation map includes:
  • the first indicator in the navigation map is projected onto the plane of the perceived image, and the similarity is compared with the first indicator in the perceived image, and the first indicator whose similarity value reaches the second set threshold As a matching target indicator.
  • correcting the elevation of the vehicle provided by the preset positioning device includes:
  • the average value of the elevation of the lane line is used as the elevation of the vehicle at the current position to correct the elevation of the vehicle provided by the preset positioning device.
  • the method further includes:
  • the indication mark is not obtained in the perception image of the continuously set number of frames, and/or the indication mark in the navigation map is not obtained, then return to the execution of obtaining the vehicle provided by the preset positioning device The current position of the operation to revise the pose of the vehicle again.
  • the method further includes:
  • the initialization operation of the navigation map is stopped, and the current automatic driving mode is switched to the manual driving mode.
  • the embodiment of the present invention also provides a device for correcting the vehicle pose when the navigation map is initialized, and the device includes:
  • the elevation correction module is configured to obtain the current position of the vehicle provided by the preset positioning device, and based on the lane line information corresponding to the current position in the navigation map, correct the elevation of the vehicle provided by the preset positioning device;
  • the target indicator determination module is configured to select a target indicator that matches each first indicator in the perception image from the first indicator signs of the navigation map, and the first indicator includes a traffic indicator;
  • the first correction module is configured to perform a first correction process on the pose of the vehicle in the navigation map based on the position of the target indicator;
  • the second indicator determination module is configured to determine, according to the posture and elevation of the vehicle after the first correction processing, other types of second matching other than the first indicator in the navigation map and the perceived image An indicator, wherein the second indicator includes a lane line and/or a street light pole;
  • the second correction module is configured to perform a second correction process on the vehicle pose after the first correction process based on the position of the target indication mark and the matched second indication mark, so that the first indication in the navigation map
  • the positions of the sign and the second indicator are matched with the positions of the first indicator and the second indicator in the perception image according to the vehicle pose after the second correction processing.
  • the first correction module is specifically configured as:
  • a nonlinear optimization algorithm is used to perform first correction processing on the position of the vehicle’s six degrees of freedom and three degrees of freedom, so that each first indicator in the navigation map and the perception image
  • the projection error of the vehicle position on the preset standardized plane based on the first correction processing is smaller than the first preset distance.
  • the second correction module is specifically configured as:
  • the second preset distance corresponding to each of the first indicator mark and the second indicator mark is smaller than the first preset distance corresponding to each.
  • the target indicator determination module is specifically configured as:
  • each first indicator in the perceptual image compares the reconstructed first indicator with the first indicator in the navigation map for similarity, and compare the similarity value to the first set threshold.
  • the first indicator serves as the matched target indicator.
  • the target indicator determination module is specifically configured as:
  • Selecting the target indicator that matches the first indicator in the perception image from the first indicator of the navigation map includes:
  • the first indicator in the navigation map is projected onto the plane of the perceived image, and the similarity is compared with the first indicator in the perceived image, and the first indicator whose similarity value reaches the second set threshold As a matching target indicator.
  • the elevation correction module is specifically configured as:
  • the average value of the elevation of the lane line is used as the elevation of the vehicle at the current position to correct the elevation of the vehicle provided by the preset positioning device.
  • the device further includes:
  • the indication mark is not obtained in the perception image of the continuously set number of frames, and/or the indication mark in the navigation map is not obtained, then return to the execution of obtaining the vehicle provided by the preset positioning device The current position of the operation to revise the pose of the vehicle again.
  • the device further includes:
  • the initialization operation of the navigation map is stopped, and the current automatic driving mode is switched to the manual driving mode.
  • an embodiment of the present invention also provides a vehicle-mounted terminal, including:
  • a memory storing executable program codes
  • a processor coupled with the memory
  • the processor calls the executable program code stored in the memory to execute part or all of the steps of the method for correcting the vehicle pose when the navigation map is initialized according to any embodiment of the present invention.
  • an embodiment of the present invention also provides a computer-readable storage medium that stores a computer program, and the computer program includes the correction of the vehicle pose when the navigation map provided by any embodiment of the present invention is initialized. Instructions for some or all of the steps of the method.
  • the embodiments of the present invention also provide a computer program product, which when the computer program product runs on a computer, causes the computer to execute the navigation map provided by any embodiment of the present invention. Part or all of the steps of the correction method.
  • the technical solution provided by the embodiment of the present invention uses the position of the target traffic indicator (generally referred to as the traffic sign) in the navigation map that matches the perceptual image on a normal road section with comprehensive traffic indication information such as traffic signs and traffic markings ,
  • the first correction process of the vehicle pose is completed, that is, the rough correction. Since the traffic indication information in this normal road section is relatively comprehensive, after the rough correction of the vehicle is completed, the lane line or street light pole can be used to perform the second correction process, that is, the precise correction, to obtain a more accurate vehicle.
  • the positioning accuracy solves the problem of low positioning accuracy using consumer-grade preset positioning devices. In application scenarios with comprehensive information such as traffic signs, the consumer-level preset positioning device has the function of providing centimeter-level position accuracy.
  • the invention points of the present invention include:
  • the traffic signs in the perception image and navigation map such as traffic signs
  • the posture of the vehicle can be corrected by using the traffic signs to complete the initialization of the navigation map
  • Operation to enable consumer-grade positioning equipment to have high-precision positioning functions is one of the invention points of the present invention.
  • the first indicator signs such as traffic signs
  • three-dimensional reconstruction of the first indicator signs in the perception image is carried out, or the first indicator signs in the navigation map are projected onto the plane of the perception image and combined with the navigation map
  • the similarity of the traffic signs in is used as one of the weights for judging the quality of the indicator, so as to screen out the first indicator of the target in the perception image that matches the position on the navigation map, which is one of the invention points of the present invention.
  • the determined vehicle line elevation can be used as the elevation of the current position of the vehicle to complete the correction of the vehicle elevation, thereby adding subsequent navigation maps and perception images
  • the probability of correct matching is one of the invention points of the present invention.
  • FIG. 1 is a schematic flowchart of a method for correcting vehicle pose during initialization of a navigation map according to an embodiment of the present invention
  • 2a is a schematic flowchart of a method for correcting vehicle pose during initialization of a navigation map according to an embodiment of the present invention
  • FIG. 2b is a schematic diagram of projection before height correction of a vehicle according to an embodiment of the present invention.
  • FIG. 2c is a schematic diagram of projection after the elevation of a vehicle is corrected according to an embodiment of the present invention.
  • 2d is a schematic diagram of projection before rough pose correction of a vehicle according to an embodiment of the present invention.
  • FIG. 2e is a schematic diagram of projection after rough pose correction of a vehicle according to an embodiment of the present invention.
  • 2f is a schematic diagram of a projection after accurate pose correction of a vehicle according to an embodiment of the present invention.
  • FIG. 3 is a schematic structural diagram of a device for correcting vehicle pose during initialization of a navigation map according to an embodiment of the present invention
  • Fig. 4 is a schematic structural diagram of a vehicle-mounted terminal provided by an embodiment of the present invention.
  • FIG. 1 is a schematic flowchart of a method for correcting vehicle pose during initialization of a navigation map according to an embodiment of the present invention.
  • This method is typically applied to an unmanned vehicle on a normal road section with comprehensive information such as traffic signs, and when it enters an outdoor high-precision map for the first time, the method can be executed by the vehicle pose correction device when the navigation map is initialized
  • the device can be implemented by software and/or hardware, and generally can be integrated in a vehicle-mounted computer, an in-vehicle industrial control computer (Industrial Personal Computer, IPC) and other vehicle-mounted terminals, which are not limited in the embodiment of the present invention.
  • IPC Intelligent Personal Computer
  • the method provided in this embodiment specifically includes:
  • the preset positioning device is a single-point GPS or a low-precision consumer-grade positioning device.
  • the navigation map refers to a high-precision map with a centimeter-level error level applied to automatic driving.
  • the elevation of the vehicle refers to the altitude of the vehicle provided by the consumer-grade positioning device.
  • the positioning accuracy is low, sometimes with an error of a few meters or even a dozen meters, but the lane line height does not change much within the error range. Therefore, according to the current position of the vehicle provided by the consumer-grade positioning device, the navigation map can search for lane line information a few meters near the current position, so as to use the lane line information to correct the height of the vehicle to pull the vehicle to the height of the lane line.
  • the vehicle elevation can be corrected first, and then the vehicle pose can be corrected, or the vehicle pose can be corrected first. Correction, and then the elevation of the vehicle, this embodiment does not specifically limit this.
  • the perception image is obtained after recognizing the image containing the traffic sign collected by the camera using a preset perception model.
  • the preset perception model can use a large number of road sample images marked with image semantic features to train the perception model in advance.
  • the semantic features of the image may include traffic signs, lane lines, dashed end points of lane lines, prismatic lines, and Zebra new traffic signs.
  • the preset perception model can be obtained in the following ways:
  • the training sample set includes multiple sets of training sample data, each set of training sample data includes road sample images and corresponding road perception sample images marked with image semantic features; based on the training sample set to build the initial neural network
  • a preset perception model is obtained through training, and the preset perception model makes the road sample images in each set of training sample data associated with corresponding road perception sample images marked with image semantic features.
  • the output of the model can be called perceptual image.
  • the traffic sign is more informative than other signs, it can provide front and rear, left, and right constraints for the position of the vehicle body. Therefore, in normal road sections with more comprehensive traffic signs, the traffic sign is preferably used as the traffic sign in this embodiment.
  • the first indicator roughly corrects the vehicle pose, and selects a second indicator of a different type from the first indicator, such as lane lines and/or street light poles and other indicators to accurately correct the vehicle pose.
  • a second indicator of a different type from the first indicator such as lane lines and/or street light poles and other indicators to accurately correct the vehicle pose.
  • the traffic sign when the vehicle travels to such a special road section, due to the lack of positioning signs such as traffic signs, it can only be used as indicator signs for rough posture correction of the vehicle through indicator signs such as street light poles or lane lines.
  • selecting a target indicator that matches each first indicator in the perception image from the first indicator of the navigation map can be achieved in the following manner:
  • the triangulation algorithm is used to reconstruct each first indicator in the perception image, and the reconstructed first indicator is compared with the first indicator in the navigation map for similarity, and the similarity value reaches the first
  • the first indicator of the threshold is set as the matched target indicator.
  • selecting a target indicator that matches each first indicator in the perception image from the first indicator of the navigation map can also be implemented in the following manner:
  • the first indicator in the navigation map is projected onto the plane of the perception image, and the similarity is compared with the first indicator in the perception image, and the first indicator whose similarity value reaches the second set threshold is regarded as the matching one Target indicator.
  • the target indicator can be compared to the navigation map based on the position of the target indicator.
  • the pose of the vehicle is continuously corrected.
  • the target indicator contains multiple sets of indicators whose similarity values meet the requirements, they can be sorted in the order of the similarity value from high to low, and the similarity value
  • the next step of correcting the vehicle pose is carried out in sequence from high to low.
  • the purpose of correcting the pose of the vehicle is to minimize the deviation between the current position of the vehicle and the actual correct position of the vehicle.
  • an iterative correction method can be used to make the current position of the vehicle continuously approach the true position of the vehicle.
  • matching target signs such as traffic signs
  • the first correction process is to use the position of the target traffic sign to roughly correct the vehicle pose, so that the distance error between the vehicle pose and the real pose is reduced.
  • the pose of the vehicle is changed. Therefore, based on the corrected vehicle position, the display content in the navigation map will change accordingly. After the display content in the navigation map is updated, the indicators in the perception map that match the navigation map should also be updated accordingly. Since this embodiment is mainly applied to normal road sections with relatively comprehensive traffic signs, in addition to traffic signs, other types of signs can be combined to further correct the vehicle's pose. For example, because the lane line can provide vehicle body position Up and down and left and right directions, street light poles can provide front and rear and left and right constraints on the vehicle body. Therefore, this embodiment can use lane lines, or street light poles, or a combination of the above two as the type different from the first indicator sign. The second indicator can further correct the vehicle pose.
  • the non-linear correction algorithm can still be used to implement the second correction processing on the pose of the vehicle.
  • the second correction process of the vehicle pose is based on the rough pose correction of the vehicle, combined with the various types of indicators that can be identified in the road section with more comprehensive traffic indicator information, such as street light poles and lane lines. Further precise correction of vehicle pose.
  • the check method of the second correction processing result can be to project various types of indicator marks in the navigation map onto the plane of the perception image, and determine the projection distance from the corresponding type indicator marks in the perception image, if the projection distance satisfies
  • the condition of error convergence can indicate that the positions of various types of indicator marks in the navigation map match the position of the corresponding type of indicator marks in the perception image according to the vehicle pose after the second correction process, that is, the result of accurate vehicle correction Meet the preset requirements, that is, complete the accurate correction of the vehicle pose on the road section with a lack of traffic signs.
  • the display information in the navigation map can be updated to complete the initialization of the navigation map, and the matching relationship between the navigation map and the perception image can be saved.
  • this embodiment preferably uses traffic signs as the first sign to perform the first correction process on the vehicle, and uses street light poles. And the lane line is used as the second indicator to perform the second correction process on the vehicle.
  • traffic signs are not limited to traffic signs. It is also possible to use indicator signs such as streetlight poles or lane lines as the first indicator to perform the first correction process on the vehicle, and use the traffic sign as the second indicator to perform the second correction process on the vehicle.
  • the technical solution provided by the embodiment of the present invention uses the position of the target traffic indicator (generally referred to as the traffic sign) in the navigation map that matches the perceptual image on a normal road section with comprehensive traffic indication information such as traffic signs and traffic markings ,
  • the first correction process of the vehicle pose is completed, that is, the rough correction. Since the traffic indication information in this normal road section is relatively comprehensive, after the rough correction of the vehicle is completed, the lane line or street light pole can be used to perform the second correction process, that is, the precise correction, to obtain a more accurate vehicle.
  • the positioning accuracy solves the problem of low positioning accuracy using consumer-grade preset positioning devices. In application scenarios with comprehensive information such as traffic signs, the consumer-level preset positioning device has the function of providing centimeter-level position accuracy.
  • the initialization operation of the navigation map is stopped, and the current automatic driving mode is switched to manual driving mode, that is, the initialization state is exited To ensure the stability of the vehicle system.
  • FIG. 2a is a schematic flowchart of a method for correcting vehicle pose during initialization of a navigation map according to an embodiment of the present invention. This embodiment optimizes the process of vehicle pose correction on the basis of the foregoing embodiment. As shown in Figure 2a, the method includes:
  • Fig. 2b is a schematic diagram of a projection before the elevation of a vehicle is corrected according to an embodiment of the present invention.
  • Fig. 2c is a schematic diagram of a projection after the elevation of a vehicle is corrected according to an embodiment of the present invention.
  • 1 represents the street light pole in the perceived image;
  • 2 represents the street light pole in the navigation map;
  • 3 represents the real position of the vehicle;
  • 4 represents the current position of the vehicle in the navigation map.
  • the vehicle can be pulled to the height of the lane line.
  • step 230 is the process of roughly correcting the vehicle's pose.
  • This process mainly uses the target indicator recognized in 220, such as a traffic sign, to correct the position of the vehicle, so that the distance between the position of the vehicle and its real position is reduced.
  • the optimized position can be checked.
  • the traffic sign in the navigation map can be used to set the corrected vehicle pose on the preset standardized plane.
  • the preset standardized plane is preferably the plane where the perceived image is located, or it may be the normalized plane of the camera.
  • the normalized plane can be established in the camera coordinate system and the distance from the origin of the camera coordinate system is 1 meter.
  • FIG. 2d is a schematic diagram of projection before rough pose correction of a vehicle according to an embodiment of the present invention
  • FIG. 2e is a schematic diagram of projection after rough pose correction of a vehicle according to an embodiment of the present invention.
  • 1 represents the traffic sign in the perceived image
  • 2 represents the traffic sign after projection in the navigation map
  • 3 represents the real position of the vehicle
  • 4 represents the current position of the vehicle in the navigation map.
  • the projection position of the matching traffic sign in the navigation map and the perception image on the normalized plane is reduced compared to Figure 2d.
  • the position of the vehicle can be corrected by using the location of the matching traffic sign in the navigation map and the perceived image, so that the position of the vehicle in Figure 2e is also closer to its true position.
  • the second indicator includes a lane Wire and/or street light pole.
  • step 250 is the process of performing accurate pose correction on the vehicle.
  • the pose of the vehicle in the navigation map has changed. Therefore, based on the corrected vehicle position, the display content in the navigation map will change accordingly.
  • the traffic signs that match the navigation map in the perception map should also be updated accordingly.
  • the navigation map and the perceptual image can be used to match other signs other than traffic signs, such as lane lines or street lamp poles. Or combine the positions of the two to further optimize the pose of the vehicle, that is, perform a second correction process. After the second correction process, the position of the vehicle is closer to the real position.
  • the preset standardized plane respectively determine whether the projection distances of the first indicator and second indicator projected in the navigation map and the corresponding first indicator and second indicator in the perceived image are both smaller than the corresponding first indicator 2.
  • the second preset distance corresponding to each of the first indicator mark and the second indicator mark is smaller than the first preset distance corresponding to each.
  • the verification method of the second correction processing result is the same as the verification method of the first correction processing result, that is, on the normalized plane or on the plane where the perceived image is located, judge the traffic signs and street lights in the navigation map respectively.
  • the projection error between the projection positions of the indicator signs such as poles and lane lines and the projection positions of the corresponding traffic signs, street light poles, and lane lines in the perceived image if the error is less than the second preset distance, for example, less than 10- 15 pixels, it means that the correction result of the vehicle pose meets the condition of error convergence.
  • the nonlinear optimization algorithm may be used to iteratively correct the vehicle pose until the projection error is less than the second preset distance.
  • FIG. 2f is a schematic diagram of projection after accurate pose correction of a vehicle according to an embodiment of the present invention.
  • 1 represents the traffic sign in the perceived image
  • 2 represents the traffic sign in the navigation map after projection
  • 3 represents the actual position of the vehicle
  • 4 represents the current position of the vehicle in the navigation map
  • 5 represents the street light pole in the perceived image
  • 6 represents the street light pole in the navigation map after projection
  • 7 represents the lane line in the perceived image
  • 8 represents the lane line in the navigation map after projection.
  • the various types of traffic signs in the navigation map correspond to the corresponding ones in the perception image.
  • the projections of various types of traffic signs on the normalized plane are close to coincidence.
  • the update operation of the display content of the navigation map can be performed to complete the initialization process of the navigation map.
  • FIG. 3 is a schematic structural diagram of a device for correcting vehicle pose during initialization of a navigation map according to an embodiment of the present invention.
  • the device includes an elevation correction module 310, a target indicator determination module 320, a first correction module 330, a second indicator determination module 340, and a second correction module 330; among them,
  • the elevation correction module 310 is configured to obtain the current position of the vehicle provided by the preset positioning device, and based on the lane line information corresponding to the current position in the navigation map, correct the elevation of the vehicle provided by the preset positioning device;
  • the target indicator determination module 320 is configured to select a target indicator that matches each first indicator in the perception image from each first indicator of the navigation map, and the first indicator includes a traffic indicator ;
  • the first correction module 330 is configured to perform a first correction process on the pose of the vehicle in the navigation map based on the position of the target indicator;
  • the second indicator determination module 340 is configured to determine, according to the pose and elevation of the vehicle after the first correction processing, the navigation map and the perceived image that match other types of second indicators other than the first indicator.
  • Indication signs wherein the second indication signs include lane lines and/or street light poles;
  • the second correction module 350 is configured to perform a second correction process on the vehicle pose after the first correction process based on the position of the target indicator and the matched second indicator mark, so that the first correction process is performed on the navigation map.
  • the positions of the indicator and the second indicator respectively match the positions of the first indicator and the second indicator in the perception image according to the vehicle pose after the second correction processing.
  • the technical solution provided by the embodiment of the present invention uses the position of the target traffic indicator (generally referred to as the traffic sign) in the navigation map that matches the perceptual image on a normal road section with comprehensive traffic indication information such as traffic signs and traffic markings ,
  • the first correction process of the vehicle pose is completed, that is, the rough correction. Since the traffic indication information in this normal road section is relatively comprehensive, after the rough correction of the vehicle is completed, the lane line or street light pole can be used to perform the second correction process, that is, the precise correction, to obtain a more accurate vehicle.
  • the positioning accuracy solves the problem of low positioning accuracy using consumer-grade preset positioning devices. In application scenarios with comprehensive information such as traffic signs, the consumer-level preset positioning device has the function of providing centimeter-level position accuracy.
  • the first correction module is specifically configured as:
  • a nonlinear optimization algorithm is used to perform first correction processing on the position of the vehicle’s six degrees of freedom and three degrees of freedom, so that each first indicator in the navigation map and the perception image
  • the projection error of the vehicle position on the preset standardized plane based on the first correction processing is smaller than the first preset distance.
  • the second correction module is specifically configured as:
  • the second preset distance corresponding to each of the first indicator mark and the second indicator mark is smaller than the first preset distance corresponding to each.
  • the target indicator determination module is specifically configured as:
  • each first indicator in the perceptual image compares the reconstructed first indicator with the first indicator in the navigation map for similarity, and compare the similarity value to the first set threshold.
  • the first indicator serves as the matched target indicator.
  • the target indicator determination module is specifically configured as:
  • Selecting the target indicator that matches the first indicator in the perception image from the first indicator of the navigation map includes:
  • the first indicator in the navigation map is projected onto the plane of the perceived image, and the similarity is compared with the first indicator in the perceived image, and the first indicator whose similarity value reaches the second set threshold As a matching target indicator.
  • the elevation correction module is specifically configured as:
  • the average value of the elevation of the lane line is used as the elevation of the vehicle at the current position to correct the elevation of the vehicle provided by the preset positioning device.
  • the device further includes:
  • the indication mark is not obtained in the perception image of the continuously set number of frames, and/or the indication mark in the navigation map is not obtained, then return to the execution of obtaining the vehicle provided by the preset positioning device The current position of the operation to revise the pose of the vehicle again.
  • the device further includes:
  • the initialization operation of the navigation map is stopped, and the current automatic driving mode is switched to the manual driving mode.
  • the device for correcting the vehicle pose when the navigation map is initialized can execute the method for correcting the vehicle pose when the navigation map is initialized provided by any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method. .
  • the method for correcting the vehicle pose during initialization of the navigation map provided by any embodiment of the present invention.
  • FIG. 4 is a schematic structural diagram of a vehicle-mounted terminal according to an embodiment of the present invention.
  • the vehicle-mounted terminal may include:
  • a memory 701 storing executable program codes
  • a processor 702 coupled with the memory 701;
  • the processor 702 calls the executable program code stored in the memory 701 to execute the method for correcting the vehicle pose when the navigation map is initialized according to any embodiment of the present invention.
  • the embodiment of the present invention discloses a computer-readable storage medium that stores a computer program, wherein the computer program enables the computer to execute the method for correcting the vehicle pose when the navigation map is initialized according to any embodiment of the present invention.
  • the embodiment of the present invention discloses a computer program product, wherein when the computer program product runs on a computer, the computer is caused to execute part or all of the steps of the method for correcting the vehicle pose when the navigation map provided by any embodiment of the present invention is initialized .
  • B corresponding to A means that B is associated with A, and B can be determined according to A.
  • determining B according to A does not mean that B is determined only according to A, and B can also be determined according to A and/or other information.
  • the functional units in the embodiments of the present invention may be integrated into one processing unit, or each unit may exist alone physically, or two or more units may be integrated into one unit.
  • the above-mentioned integrated unit can be implemented in the form of hardware or software functional unit.
  • the aforementioned integrated unit is implemented in the form of a software functional unit and sold or used as an independent product, it can be stored in a computer-accessible memory.
  • the essence of the technical solution of the present invention or the part that contributes to the existing technology or all or part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a memory.
  • a computer device which may be a personal computer, a server, or a network device, etc., specifically a processor in a computer device
  • the program can be stored in a computer-readable storage medium.
  • the storage medium includes read-only Memory (Read-Only Memory, ROM), Random Access Memory (RAM), Programmable Read-only Memory (PROM), Erasable Programmable Read Only Memory, EPROM), One-time Programmable Read-Only Memory (OTPROM), Electronically-Erasable Programmable Read-Only Memory (EEPROM), CD-ROM (Compact Disc) Read-Only Memory, CD-ROM) or other optical disk storage, magnetic disk storage, tape storage, or any other computer-readable medium that can be used to carry or store data.
  • Read-Only Memory ROM
  • RAM Random Access Memory
  • PROM Programmable Read-only Memory
  • EPROM Erasable Programmable Read Only Memory
  • OTPROM One-time Programmable Read-Only Memory
  • EEPROM Electronically-Erasable Programmable Read-Only Memory
  • CD-ROM Compact Disc

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

一种导航地图在初始化时车辆位姿的修正方法和装置，该方法包括：基于导航地图中车辆当前位置对应的车道线信息，对预设定位装置提供的车辆的高程进行修正（110）；从导航地图中的各第一指示标志选择与感知图像中的各第一指示标志相匹配的目标指示标志（120）；基于目标指示标志的位置对车辆当前位姿进行第一修正处理（130）；根据第一修正处理后车辆的位姿和高程，确定导航地图和感知图像中除第一指示标志之外相匹配的其他类型的第二指示标志（140）；基于目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得导航地图中第一、第二指示标志的位置根据第二修正处理后的车辆位姿，分别与感知图像中的第一、第二指示标志的位置相匹配（150）。该方法在指示标志全面的正常路段，达到了使用消费级预设定位装置也能进行高精度定位的技术效果。

Description

一种导航地图在初始化时车辆位姿的修正方法和装置 技术领域
本发明涉及自动驾驶技术领域，具体涉及一种导航地图在初始化时车辆位姿的修正方法和装置。
背景技术
在自动驾驶领域，导航定位至关重要。近年来，深度学习等技术的成果，极大促进了图像语义分割、图像识别领域的发展，这为导航地图及导航定位提供了坚实的基础。
在基于高精度地图的定位方案中，当无人驾驶车辆行驶在交通标志和交通标线等信息较为全面的正常路段时，如果车辆第一次进入高精度地图，则需要获得一个全局而精准的位置信息进行初始化，继而可以使用高精度地图进行精准定位，即绝对位置精度可达到厘米级。但在消费级设备，例如单点GPS(Global Positioning System，全球定位系统)与廉价IMU(Inertial measurement unit，惯性测量单元)的定位方案中，由于单点GPS所提供的定位精度信息的误差较大，利用单点GPS所提供的位置，将高精度地图中的交通标志信息与利用深度学习感知模型感知出图像中的交通标志信息，例如交通指示牌等，进行重投影匹配时，容易造成车道线左右匹配错误，路灯杆前后向匹配错误等问题。如果利用错误的匹配信息对车体位置进行修正，不仅不能利用高精地图使车体的位置精度达到厘米级，反而可能会使车体的位置与真实位置偏离更大。
发明内容
本发明实施例公开了一种导航地图在初始化时车辆位姿的修正方法和装置，解决了无人驾驶车辆在各交通标志和交通标线信息全面的正常路段的场景下，使用消费级预设定位装置定位精度不高的问题，达到了使用消费级预设定位装置也能进行高精度定位的技术效果。
第一方面，本发明实施例公开了一种导航地图在初始化时车辆位姿的修正方法，该方法包括：
获取预设定位装置提供的车辆的当前位置，并基于导航地图中所述当前位置对应的车道线信息，对所述预设定位装置提供的车辆的高程进行修正；
从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，所述第一指示标志包括交通指示牌；
基于所述目标指示标志的位置，对所述导航地图中车辆的位姿进行第一修正处理；
根据第一修正处理后车辆的位姿和高程，确定所述导航地图和所述感知图像中除所述第一指示标志之外相匹配的其他类型的第二指示标志，其中，所述第二指示标志包括车道线和/或路灯杆；
基于所述目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，分别与所述感知图像中的第一指示标志和第二指示标志的位置相匹配。
可选的，基于所述目标指示标志的位置，对所述导航地图中车辆的位姿进行第一修正处理，包括：
基于所述目标指示标志的位置，通过非线性优化算法对车辆的六自由度中的位置三自由度进行第一修正处理，以使所述导航地图和所述感知图像中的各个第一指示标志基于第一修正处理后的车辆位置在预设标准化平面上的投影误差小于第一预设距离。
可选的，确定投影后导航地图中的交通标志与投影后感知图像中的交通标志的相似度值，包括：
计算投影后导航地图中的交通标志的投影长度，与投影后感知图像中的交通标志的投影长度的比值，并将所述比值作为相似度值。
可选的，基于所述目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，分别与所述感知图像中的第一指示标志和第二指示标志的位置相匹配，包括：
基于所述目标指示标志和相匹配的第二指示标志的位置，通过非线性优化算法对经过第一修正处理后的车辆位姿进行第二修正处理；
基于第二修正处理后车辆的位姿，分别将所述导航地图和感知图像中的各个第一指示标志和各个第二指示标志投影到预设标准化平面；
在所述预设标准化平面上，分别判断导航地图中投影后的第一指示标志和第二指示标志与感知图像中对应的第一指示标志和第二指示标志的投影距离是否均小于对应的第二预设距离；
如果均小于第二预设距离，则确定所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，均与所述感知图像中第一指示标志和第二指示标志的位置相匹配；
其中，第一指示标志和第二指示标志各自所对应的第二预设距离均小于各自所对应的第一预设距离。
可选的，从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，包括：
将感知图像中的各第一指示标志进行重建，并将重建后的第一指示标志与所述导航地图中的第一指示标志进行相似度比较，并将相似度值达到第一设定阈值的第一指示标志作为相匹配的目标指示标志。
可选的，从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，包括：
将所述导航地图中的第一指示标志投影到感知图像所在平面，并与所述感知图像中的第一指示标志进行相似度比较，将相似度值达到第二设定阈值的第一指示标志作为相匹配的目标指示标志。
可选的，基于导航地图中所述当前位置对应的车道线信息，对所述预设定位装置提供的车辆的高程进行修正，包括：
确定导航地图中所述当前位置对应的车道线的高程的平均值；
将所述车道线的高程的平均值作为当前位置处车辆的高程，以对预设定位装置提供的车辆的高程进行修正。
可选的，在对所述导航地图中的车辆位姿进行第二修正处理之后，所述方法还包括：
基于第二修正处理后车辆的位姿更新所述导航地图中的显示内容；
在车辆的行驶过程中，如果在连续设定帧数的感知图像中未获取到指示标志，和/或未获取到所述导航地图中的指示标志，则返回执行获取预设定位装置提供的车辆的当前位置的操作，以对车辆的位姿进行再次修正。
可选的，所述方法还包括：
对于预设定位装置提供的车辆的位置，如果检测出在所述导航地图中不存在对应的覆盖区域，则停止对所述导航地图的初始化操作，并将当前自动驾驶模式切换为手动驾驶模式。
第二方面，本发明实施例还提供了一种导航地图在初始化时车辆位姿的修正装置，该装置包括：
高程修正模块，被配置为获取预设定位装置提供的车辆的当前位置，并基于导航地图中所述当前位置对应的车道线信息，对所述预设定位装置提供的车辆的高程进行修正；
目标指示标志确定模块，被配置为从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，所述第一指示标志包括交通指示牌；
第一修正模块，被配置为基于所述目标指示标志的位置，对所述导航地图中车辆的位姿进行第一修正处理；
第二指示标志确定模块，被配置为根据第一修正处理后车辆的位姿和高程，确定所述导航地图和所述感知图像中除所述第一指示标志之外相匹配的其他类型的第二指示标志，其中，所述第二指示标志包括车道线和/或路灯杆；
第二修正模块，被配置为基于所述目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，分别与所述感知图像中的第一指示标志和第二指示标志的位置相匹配。
可选的，所述第一修正模块，具体被配置为：
基于所述目标指示标志的位置，通过非线性优化算法对车辆的六自由度中的位置三自由度进行第一修正处理，以使所述导航地图和所述感知图像中的各个第一指示标志基于第一修正处理后的车辆位置在预设标准化平面上的投影误差小于第一预设距离。
可选的，所述第二修正模块，具体被配置为：
基于所述目标指示标志和相匹配的第二指示标志的位置，通过非线性优化算法对经过第一修正处理后的车辆位姿进行第二修正处理；
基于第二修正处理后车辆的位姿，分别将所述导航地图和感知图像中的各个第一指示标志和各个第二指示标志投影到预设标准化平面；
在所述预设标准化平面上，分别判断导航地图中投影后的第一指示标志和第二指示标志与感知图像中对应的第一指示标志和第二指示标志的投影距离是否均小于对应的第二预设距离；
如果均小于第二预设距离，则确定所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，均与所述感知图像中第一指示标志和第二指示标志的位置相匹配；
其中，第一指示标志和第二指示标志各自所对应的第二预设距离均小于各自所对应的第一预设距离。
可选的，所述目标指示标志确定模块，具体被配置为：
将感知图像中的各第一指示标志进行重建，并将重建后的第一指示标志与所述导航地图中的第一指示 标志进行相似度比较，并将相似度值达到第一设定阈值的第一指示标志作为相匹配的目标指示标志。
可选的，所述目标指示标志确定模块，具体被配置为：
从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，包括：
将所述导航地图中的第一指示标志投影到感知图像所在平面，并与所述感知图像中的第一指示标志进行相似度比较，将相似度值达到第二设定阈值的第一指示标志作为相匹配的目标指示标志。
可选的，所述高程修正模块，具体被配置为：
确定导航地图中所述当前位置对应的车道线的高程的平均值；
将所述车道线的高程的平均值作为当前位置处车辆的高程，以对预设定位装置提供的车辆的高程进行修正。
可选的，所述装置还包括：
在对所述导航地图中的车辆位姿进行第二修正处理之后，基于第二修正处理后车辆的位姿更新所述导航地图中的显示内容；
在车辆的行驶过程中，如果在连续设定帧数的感知图像中未获取到指示标志，和/或未获取到所述导航地图中的指示标志，则返回执行获取预设定位装置提供的车辆的当前位置的操作，以对车辆的位姿进行再次修正。
可选的，所述装置还包括：
对于预设定位装置提供的车辆的位置，如果检测出在所述导航地图中不存在对应的覆盖区域，则停止对所述导航地图的初始化操作，并将当前自动驾驶模式切换为手动驾驶模式。
第三方面，本发明实施例还提供了一种车载终端，包括：
存储有可执行程序代码的存储器；
与所述存储器耦合的处理器；
所述处理器调用所述存储器中存储的所述可执行程序代码，执行本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法的部分或全部步骤。
第四方面，本发明实施例还提供了一种计算机可读存储介质，其存储计算机程序，所述计算机程序包括用于执行本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法的部分或全部步骤的指令。
第五方面，本发明实施例还提供了一种计算机程序产品，当所述计算机程序产品在计算机上运行时，使得所述计算机执行本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法的部分或全部步骤。
本发明实施例提供的技术方案，在交通标志和交通标线等交通指示信息全面的正常路段，通过利用导航地图中与感知图像中相匹配的目标交通指示标志(一般指交通指示牌)的位置，完成了对车辆位姿的第一修正处理，即粗略修正。由于该正常路段中交通指示信息较为全面，因此在完成车辆的粗略修正后，可利用车道线或路灯杆等指示标志对车辆位姿进行第二修正处理，即精确修正，从而得到更加准确的车辆定位精度，解决了使用消费级预设定位装置定位精度不高的问题。在交通标志等信息全面的应用场景下，使得消费级预设定位装置具有提供厘米级的位置精度的功能。
本发明的发明点包括：
1、交通标志等信息全面的应用场景下，可识别出感知图像和导航地图中的交通标志，例如交通指示牌，利用该交通指示牌可对车辆的位姿进行修正，从而完成导航地图的初始化操作，使得消费级的定位设备具有高精度的定位功能，是本发明的发明点之一。
2、在筛选如交通指示牌等第一指示标志时，通过将感知图像中的第一指示标志进行三维重建，或者将导航地图中的第一指示标志投影到感知图像所在平面，并与导航地图中的交通标志的相似度作为判断该指示标志优劣的权重之一，从而筛选出感知图像中与导航地图中位置相匹配的目标第一指示标志，是本发明的发明点之一。
3、在对车辆的位置进行修正时，采用了迭代修正的方式，可以得到更加准确的位置精度，是本发明的发明点之一。
4、通过确定导航地图中车辆当前位置周围几米范围内的车道线高程，可将确定出的车辆线高程作为车辆当前位置的高程，以完成对车辆高程的修正，从而增加后续导航地图与感知图像匹配正确的概率，是本发明的发明点之一。
5、在车辆行驶的过程中，如果在设定帧数的感知图像中未获取到如车道线、交通牌或路灯杆等指示标志，和/或未获取到导航地图中的指示标志，则需切换到导航地图的初始化状态，以保证车辆的正常运 行，是本发明的发明点之一。
附图说明
为了更清楚地说明本发明实施例中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的一种导航地图在初始化时车辆位姿的修正方法的流程示意图；
图2a为本发明实施例提供的一种导航地图在初始化时车辆位姿的修正方法的流程示意图；
图2b为本发明实施例提供的一种对车辆进行高程修正前的投影示意图；
图2c为本发明实施例提供的一种对车辆进行高程修正后的投影示意图；
图2d为本发明实施例提供的一种对车辆进行粗略位姿修正前的投影示意图；
图2e为本发明实施例提供的一种对车辆进行粗略位姿修正后的投影示意图；
图2f为本发明实施例提供的一种对车辆进行精确位姿修正后的投影示意图；
图3为本发明实施例提供的一种导航地图在初始化时车辆位姿的修正装置的结构示意图；
图4为本发明实施例提供的一种车载终端的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
需要说明的是，本发明实施例及附图中的术语“包括”和“具有”以及它们任何变形，意图在于覆盖不排他的包含。例如包含了一系列步骤或单元的过程、方法、系统、产品或设备没有限定于已列出的步骤或单元，而是可选地还包括没有列出的步骤或单元，或可选地还包括对于这些过程、方法、产品或设备固有的其它步骤或单元。
实施例一
请参阅图1，图1为本发明实施例提供的一种导航地图在初始化时车辆位姿的修正方法的流程示意图。该方法典型的是应用于无人驾驶车辆在交通标志等信息较为全面的正常路段，第一次进入室外高精度地图的场景下，该方法可由导航地图在初始化时车辆位姿的修正装置来执行，该装置可通过软件和/或硬件的方式实现，一般可集成在车载电脑、车载工业控制计算机(Industrial personal Computer，IPC)等车载终端中，本发明实施例不做限定。如图1所示，本实施例提供的方法具体包括：
110、获取预设定位装置提供的车辆的当前位置，并基于导航地图中当前位置对应的车道线信息，对定位装置提供的车辆的高程进行修正。
其中，预设定位装置为单点GPS或低精度的消费级定位设备。导航地图是指应用于自动驾驶的误差级别为厘米级的高精度地图。
本实施例中，车辆的高程是指消费级定位设备提供的车辆的海拔高度。在利用消费级定位设备对车辆进行定位时，定位精度较低，有时会有几米甚至十几米的误差，但在该误差范围内车道线高度变化不大。因此，可根据消费级定位设备提供的车辆当前位置，在导航地图中搜索当前位置附近几米的车道线信息，从而利用该车道线信息对车辆的高程进行修正，以将车辆拉到车道线高度。
具体的，可在导航地图中搜索车辆当前位置周围几米范围内车道线，并计算车道线的平均高度，即车道线的高程。将计算出的车道线的高程作为车辆当前位置的高程，以完成对车辆高程的修正。这样设置可使得后续导航地图与感知图像匹配正确的概率增加。
需要说明的是，本发明实施例对车辆高程和位姿的修正顺序不存在先后之分，可先对车辆的高程进行修正，然后再修正车辆位姿，或者也可以先完成对车辆位姿的修正，然后再修正车辆的高程，本实施例对此不做具体限定。
120、从导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志。
其中，感知图像是利用预设感知模型对摄像头采集的包含交通指示标志的图像进行识别后得到的。预设感知模型可以预先采用大量标注有图像语义特征的道路样本图像对感知模型进行训练。其中，图像语义特征可包括交通指示牌、车道线、车道线虚线端点、棱形线和斑马新等交通指示标志。通过将包含有交通指示标志的道路图像输入至训练好的预设感知模型，基于预设感知模型的识别结果，即可得到道路图像中的图像语义特征。其中，预设感知模型可以通过以下方式得到：
构建训练样本集，该训练样本集包括多组训练样本数据，每组训练样本数据包括道路样本图像和对应 的标注有图像语义特征的道路感知样本图像；基于训练样本集对搭建的初始神经网络进行训练得到预设感知模型，该预设感知模型使得每组训练样本数据中的道路样本图像与对应的标注有图像语义特征的道路感知样本图像相关联。模型输出的即可称之为感知图像。
其中，由于交通指示牌相对于其他指示标志而言信息更丰富，可以为车体位置提供前后左右向的约束，因此，在交通指示标志较为全面的正常路段，本实施例优选采用交通指示牌作为第一指示标志对车辆位姿进行粗略修正，并选择与第一指示标志类型不同的第二指示标志，例如车道线和/或路灯杆等指示标志对车辆位姿进行精确修正。相对于交通标志缺乏的特殊路段，当车辆行驶到这样的特殊路段时，由于缺乏交通指示牌等定位标志，只能通过路灯杆或车道线等指示标志作为车辆粗略位姿修正的指示标志。
示例性的，从导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，可通过如下方式来实现：
采用三角化算法对感知图像中的各第一指示标志进行重建，并将重建后的第一指示标志与所述导航地图中的第一指示标志进行相似度比较，并将相似度值达到第一设定阈值的第一指示标志作为相匹配的目标指示标志。
示例性的，从导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，还可通过如下方式来实现：
将导航地图中的第一指示标志投影到感知图像所在平面，并与感知图像中的第一指示标志进行相似度比较，将相似度值达到第二设定阈值的第一指示标志作为相匹配的目标指示标志。
进一步的，由于目标指示标志的确定说明感知图像中的目标指示标志已经与导航地图中对应的目标指示标志建立了一一对应的匹配关系，因此，可基于目标指示标志的位置，对导航地图中车辆的位姿进行不断修正。在对车辆位姿进行修正时，由于目标指示标志中包含相似度值符合要求的多组指示标志，因此，可将其按照相似度值从高到低的顺序进行排序，并按照相似度值的从高到低顺序依次进行下一步车辆位姿的修正环节。
130、基于目标指示标志的位置，对导航地图中车辆的位姿进行第一修正处理。
其中，对车辆的位姿进行修正是为了使车辆的当前位置与车辆实际的正确位置之间的偏差降到最低，具体可采用迭代修正的方式使得车辆的当前位置不断逼近于车辆的真实位置。
本实施例中，在交通指示标志全面的正常路段，可从导航地图和感知图像中识别出相匹配的目标指示标志，例如交通指示牌，作为对车辆位姿修正的标准。第一修正处理即是利用目标交通指示牌的位置对车辆位姿进行粗略修正，使得在车辆位姿与真实位姿之间的距离误差有所减小。
140、根据第一修正处理后车辆的位姿和高程，确定导航地图和所述感知图像中除第一指示标志之外相匹配的其他类型的第二指示标志。
在步骤130对车辆进行粗略位姿修正后，车辆的位姿发生了改变。因此，基于修正后的车辆位置，导航地图中的显示内容会相应的发生改变。在更新导航地图中的显示内容后，感知地图中与导航地图相匹配的指示标志也应随之得到更新。由于本实施例主要应用于交通指示标志较为全面的正常路段，那么除了交通指示牌之外，可联合其他类型的指示标志对车辆位姿进行进一步校正，例如，由于车道线可对车体位置提供上下和左右方向的约束，路灯杆可对车体提供前后和左右方向的约束，因此，本实施例可将车道线，或者路灯杆，或者联合上述两者，作为与第一指示标志类型不同的第二指示标志，以可对车辆位姿进行进一步的修正处理。
150、基于目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得导航地图中第一指示标志和第二指示标志的位置根据第二修正处理后的车辆位姿，分别与感知图像中的第一指示标志和第二指示标志的位置相匹配。
示例性的，对车辆的位姿进行第二修正处理时仍然可采用非线性修正算法来实现。车辆位姿的第二修正处理是在对车辆进行粗略位姿修正的基础上，联合交通指示标志信息较为全面路段中可识别出的各种类型的指示标志，例如路灯杆和车道线等信息对车辆位姿进行进一步的精确修正。第二修正处理结果的校核方式可以是将导航地图中各种类型的指示标志投影到感知图像所在平面，并判断与感知图像中对应类型的指示标志之间的投影距离，如果该投影距离满足误差收敛的条件，则可说明导航地图中各种类型的指示标志的位置根据第二修正处理后的车辆位姿，与感知图像中对应类型的指示标志的位置相匹配，即车辆精确修正的结果达到预设要求，也即完成了在交通标志匮乏路段对车辆位姿的精确修正。此时，可对导航地图中的显示信息进行更新以完成导航地图的初始化，并可保存导航地图与感知图像之间的匹配关系。
需要说明的是，由于交通指示牌相对于其他指示标志而言，信息最为丰富和全面，因此，本实施例优选采用交通指示牌作为第一指示标志对车辆进行第一修正处理，并利用路灯杆和车道线作为第二指示标志对车辆进行第二修正处理。但由于本实施例是应用在交通指示标志等信息较为全面的正常路段，感知图像 和导航地图中各种类型的指示标志一般都可识别出来，因此，第一指示标志并不局限于交通指示牌，也可采用如路灯杆或车道线等类型的指示标志作为第一指示标志对车辆进行第一修正处理，并将交通指示牌作为第二指示对车辆进行第二修正处理。
本发明实施例提供的技术方案，在交通标志和交通标线等交通指示信息全面的正常路段，通过利用导航地图中与感知图像中相匹配的目标交通指示标志(一般指交通指示牌)的位置，完成了对车辆位姿的第一修正处理，即粗略修正。由于该正常路段中交通指示信息较为全面，因此在完成车辆的粗略修正后，可利用车道线或路灯杆等指示标志对车辆位姿进行第二修正处理，即精确修正，从而得到更加准确的车辆定位精度，解决了使用消费级预设定位装置定位精度不高的问题。在交通标志等信息全面的应用场景下，使得消费级预设定位装置具有提供厘米级的位置精度的功能。
进一步的，当导航地图的初始化完成后，在无人驾驶车辆的行驶过程中，如果未获取到连续设定帧数的感知图像中的指示标志(包括第一指示标志和/或第二指示标志)，和/或未获取到导航地图中的指示标志，则返回执行获取预设定位装置提供的车辆的当前位置的操作，以对导航地图中的显示内容进行再次更新，即重新进行初始化过程。但对于预设定位装置提供的车辆的位置，如果检测出导航地图中不存在对应的覆盖区域，则停止对导航地图的初始化操作，并将当前自动驾驶模式切换为手动驾驶模式，即退出初始化状态，以保证车辆系统的稳定性。
实施例二
请参阅图2a，图2a为本发明实施例提供的一种导航地图在初始化时车辆位姿的修正方法的流程示意图。本实施例在上述实施例的基础上对车辆位姿修正的过程进行了优化。如图2a所示，该方法包括：
210、获取预设定位装置提供的车辆的当前位置，并基于导航地图中当前位置对应的车道线信息，对预设定位装置提供的车辆的高程进行修正。
图2b为本发明实施例提供的一种对车辆进行高程修正前的投影示意图。图2c为本发明实施例提供的一种对车辆进行高程修正后的投影示意图。其中，1表示感知图像中的路灯杆；2表示导航地图中的路灯杆；3表示车辆的真实位置；4表示车辆在导航地图中的当前位置。如图2b和2c所示，通过对车辆的高程进行修正，可以将车辆拉到车道线高度。
220、从导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，该第一指示标志包括交通指示牌。
230、基于目标指示标志的位置，通过非线性优化算法对车辆的六自由度中的位置三自由度进行第一修正处理，以使导航地图和所述感知图像中的各个第一指示标志基于第一修正处理后的车辆位置在预设标准化平面上的投影误差小于第一预设距离。
本实施例中，步骤230即为对车辆进行粗略位姿修正的过程。此过程主要是利用220中识别出的目标指示标志，例如交通指示牌，对车辆的位置进行修正，使得车辆的位置与其真实位置之间的距离有所减小。在对车辆进行粗略位姿修正后，即第一优化处理完成后，可对优化后的位置进行校核，具体可通过导航地图中的交通指示牌基于修正后的车辆位姿在预设标准化平面上的投影位置与感知图像中对应的交通指示牌在预设标准化平面中的投影位置之间的误差来判断，如果投影误差有所减小，例如，如果该误差值小于20-30像素值，则可进行下一步车辆的精确位姿修正过程。其中，预设标准化平面优选为感知图像所在平面，也可为摄像头的归一化平面，该归一化平面可建立在摄像头坐标系下，且距离摄像头坐标系原点的距离为1米。
具体的，图2d为本发明实施例提供的一种对车辆进行粗略位姿修正前的投影示意图，图2e为本发明实施例提供的一种对车辆进行粗略位姿修正后的投影示意图。其中，1表示感知图像中的交通指示牌；2表示导航地图中投影后的交通指示牌；3表示车辆的真实位置；4表示车辆在导航地图中的当前位置。如图2e所示，在对车辆进行粗略位姿修正后，导航地图和感知图像中相匹配的交通指示牌在归一化平面上的投影位置相对于图2d而言有所减小。在交通指示标志较为全面的路段，利用导航地图和感知图像中相匹配的交通指示牌的位置，即可将车辆的位置进行修正，使得图2e中车辆的位置也更接近于其真实位置。
240、根据第一修正处理后车辆的位姿和高程，确定导航地图和所述感知图像中除第一指示标志之外相匹配的其他类型的第二指示标志，其中，该第二指示标志包括车道线和/或路灯杆。
250、基于目标指示标志和相匹配的第二指示标志的位置，通过非线性优化算法对经过第一修正处理后的车辆位姿进行第二修正处理。
本实施例中，步骤250即为对车辆进行精确位姿修正的过程。在步骤230对车辆进行粗略位姿修正后，导航地图中车辆的位姿发生了改变。因此，基于修正后的车辆位置，导航地图中的显示内容会相应的发生改变。在更新导航地图中的显示内容后，感知地图中与导航地图相匹配的交通标志也应随之得到更新。在 交通指示标志信息较为全面的正常路段，对车辆位姿进行精确修正的过程中，可利用导航地图和感知图像中除交通指示牌之外相匹配的其他指示标志，例如车道线，或者路灯杆，或者结合二者的位置，对车辆的位姿进行进一步优化，即进行第二修正处理，在第二修正处理后，车辆的位置与真实位置更加接近。
260、基于第二修正处理后车辆的位姿，分别将导航地图和感知图像中的各个第一指示标志和各个第二指示标志投影到预设标准化平面。
270、在预设标准化平面上，分别判断导航地图中投影后的第一指示标志和第二指示标志与感知图像中对应的第一指示标志和第二指示标志的投影距离是否均小于对应的第二预设距离；如果均小于第二预设距离，则确定导航地图中第一指示标志和第二指示标志的位置根据第二修正处理后的车辆位姿，均与感知图像中第一指示标志和第二指示标志的位置相匹配。
其中，第一指示标志和第二指示标志各自所对应的第二预设距离均小于各自所对应的第一预设距离。
本实施例中，第二修正处理结果的校核方式与第一修正处理结果的校核方式相同，即在归一化平面上或在感知图像所在平面，分别判断导航地图中交通指示牌、路灯杆和车道线等指示标志的投影位置与感知图像中对应的交通指示牌、路灯杆和车道线等指示标志的投影位置之间的投影误差，如果误差小于第二预设距离，例如小于10-15像素，则说明车辆位姿的修正结果符合误差收敛的条件。示例性的，在该校核过程中，如果投影误差仍然大于第二预设距离，则可继续采用非线性优化算法对车辆位姿进行迭代修正，直到投影误差小于第二预设距离。
具体的，图2f为本发明实施例提供的一种对车辆进行精确位姿修正后的投影示意图。其中，1表示感知图像中的交通指示牌；2表示投影后导航地图中的交通指示牌；3表示车辆的真实位置；4表示车辆在导航地图中的当前位置；5表示感知图像中的路灯杆；6表示投影后导航地图中的路灯杆；7表示感知图像中的车道线；8表示投影后导航地图中的车道线。如图2f所示，在交通指示标志较为全面的正常路段，利用路灯杆和车道线对车辆位姿进行精确位姿修正后，导航地图中的各种类型的交通指示标志与感知图像中对应的各种类型的交通指示标志在归一化平面上的投影接近于重合。此时，可执行对导航地图的显示内容的更新操作，完成对导航地图的初始化过程。
本实施例提供的技术方案，在指示标志较为全面的正常路段，通过利用导航地图和感知图像中的交通指示牌等第一指示标志，可实现对车辆位姿的粗略修正。在粗略修正完成后，通过联合路灯杆和车道线的位置，可对车辆的位姿进行进一步的修正处理，使得修正后车辆的位姿逼近于真实位姿，解决了使用消费级预设定位装置定位精度不高的问题，使得消费级定位装置也具有高精度的定位功能。
实施例三
请参阅图3，图3为本发明实施例提供的一种导航地图在初始化时车辆位姿的修正装置的结构示意图。如图3所示，该装置包括高程修正模块310、目标指示标志确定模块320、第一修正模块330、第二指示标志确定模块340和第二修正模块330；其中，
高程修正模块310，被配置为获取预设定位装置提供的车辆的当前位置，并基于导航地图中所述当前位置对应的车道线信息，对所述预设定位装置提供的车辆的高程进行修正；
目标指示标志确定模块320，被配置为从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，所述第一指示标志包括交通指示牌；
第一修正模块330，被配置为基于所述目标指示标志的位置，对所述导航地图中车辆的位姿进行第一修正处理；
第二指示标志确定模块340，被配置为根据第一修正处理后车辆的位姿和高程，确定所述导航地图和所述感知图像中除所述第一指示标志之外相匹配的其他类型的第二指示标志，其中，所述第二指示标志包括车道线和/或路灯杆；
第二修正模块350，被配置为基于所述目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，分别与所述感知图像中的第一指示标志和第二指示标志的位置相匹配。
本发明实施例提供的技术方案，在交通标志和交通标线等交通指示信息全面的正常路段，通过利用导航地图中与感知图像中相匹配的目标交通指示标志(一般指交通指示牌)的位置，完成了对车辆位姿的第一修正处理，即粗略修正。由于该正常路段中交通指示信息较为全面，因此在完成车辆的粗略修正后，可利用车道线或路灯杆等指示标志对车辆位姿进行第二修正处理，即精确修正，从而得到更加准确的车辆定位精度，解决了使用消费级预设定位装置定位精度不高的问题。在交通标志等信息全面的应用场景下，消费级预设定位装置具有提供厘米级的位置精度的功能。
可选的，所述第一修正模块，具体被配置为：
基于所述目标指示标志的位置，通过非线性优化算法对车辆的六自由度中的位置三自由度进行第一修正处理，以使所述导航地图和所述感知图像中的各个第一指示标志基于第一修正处理后的车辆位置在预设标准化平面上的投影误差小于第一预设距离。
可选的，所述第二修正模块，具体被配置为：
基于所述目标指示标志和相匹配的第二指示标志的位置，通过非线性优化算法对经过第一修正处理后的车辆位姿进行第二修正处理；
基于第二修正处理后车辆的位姿，分别将所述导航地图和感知图像中的各个第一指示标志和各个第二指示标志投影到预设标准化平面；
在所述预设标准化平面上，分别判断导航地图中投影后的第一指示标志和第二指示标志与感知图像中对应的第一指示标志和第二指示标志的投影距离是否均小于对应的第二预设距离；
如果均小于第二预设距离，则确定所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，均与所述感知图像中第一指示标志和第二指示标志的位置相匹配；
其中，第一指示标志和第二指示标志各自所对应的第二预设距离均小于各自所对应的第一预设距离。
可选的，所述目标指示标志确定模块，具体被配置为：
将感知图像中的各第一指示标志进行重建，并将重建后的第一指示标志与所述导航地图中的第一指示标志进行相似度比较，并将相似度值达到第一设定阈值的第一指示标志作为相匹配的目标指示标志。
可选的，所述目标指示标志确定模块，具体被配置为：
从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，包括：
将所述导航地图中的第一指示标志投影到感知图像所在平面，并与所述感知图像中的第一指示标志进行相似度比较，将相似度值达到第二设定阈值的第一指示标志作为相匹配的目标指示标志。
可选的，所述高程修正模块，具体被配置为：
确定导航地图中所述当前位置对应的车道线的高程的平均值；
将所述车道线的高程的平均值作为当前位置处车辆的高程，以对预设定位装置提供的车辆的高程进行修正。
可选的，所述装置还包括：
在对所述导航地图中的车辆位姿进行第二修正处理之后，基于第二修正处理后车辆的位姿更新所述导航地图中的显示内容；
在车辆的行驶过程中，如果在连续设定帧数的感知图像中未获取到指示标志，和/或未获取到所述导航地图中的指示标志，则返回执行获取预设定位装置提供的车辆的当前位置的操作，以对车辆的位姿进行再次修正。
可选的，所述装置还包括：
对于预设定位装置提供的车辆的位置，如果检测出在所述导航地图中不存在对应的覆盖区域，则停止对所述导航地图的初始化操作，并将当前自动驾驶模式切换为手动驾驶模式。
本发明实施例所提供的导航地图在初始化时车辆位姿的修正装置可执行本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法，具备执行方法相应的功能模块和有益效果。未在上述实施例中详尽描述的技术细节，可参见本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法。
实施例四
请参阅图4，图4为本发明实施例提供的一种车载终端的结构示意图。如图4所示，该车载终端可以包括：
存储有可执行程序代码的存储器701；
与存储器701耦合的处理器702；
其中，处理器702调用存储器701中存储的可执行程序代码，执行本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法。
本发明实施例公开一种计算机可读存储介质，其存储计算机程序，其中，该计算机程序使得计算机执行本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法。
本发明实施例公开一种计算机程序产品，其中，当计算机程序产品在计算机上运行时，使得计算机执行本发明任意实施例所提供的导航地图在初始化时车辆位姿的修正方法的部分或全部步骤。
在本发明的各种实施例中，应理解，上述各过程的序号的大小并不意味着执行顺序的必然先后，各过程的执行顺序应以其功能和内在逻辑确定，而不应对本发明实施例的实施过程构成任何限定。
在本发明所提供的实施例中，应理解，“与A相应的B”表示B与A相关联，根据A可以确定B。但还应理解，根据A确定B并不意味着仅仅根据A确定B，还可以根据A和/或其他信息确定B。
另外，在本发明各实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现，也可以采用软件功能单元的形式实现。
上述集成的单元若以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可获取的存储器中。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或者部分，可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储器中，包括若干请求用以使得一台计算机设备(可以为个人计算机、服务器或者网络设备等，具体可以是计算机设备中的处理器)执行本发明的各个实施例上述方法的部分或全部步骤。
本领域普通技术人员可以理解上述实施例的各种方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成，该程序可以存储于一计算机可读存储介质中，存储介质包括只读存储器(Read-Only Memory，ROM)、随机存储器(Random Access Memory，RAM)、可编程只读存储器(Programmable Read-only Memory，PROM)、可擦除可编程只读存储器(Erasable Programmable Read Only Memory，EPROM)、一次可编程只读存储器(One-time Programmable Read-Only Memory，OTPROM)、电子抹除式可复写只读存储器(Electrically-Erasable Programmable Read-Only Memory，EEPROM)、只读光盘(Compact Disc Read-Only Memory，CD-ROM)或其他光盘存储器、磁盘存储器、磁带存储器、或者能够用于携带或存储数据的计算机可读的任何其他介质。
以上对本发明实施例公开的一种导航地图在初始化时车辆位姿的修正方法和装置进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。

Claims (10)

  1. 一种导航地图在初始化时车辆位姿的修正方法，应用于自动驾驶，其特征在于，包括：
    获取预设定位装置提供的车辆的当前位置，并基于导航地图中所述当前位置对应的车道线信息，对所述预设定位装置提供的车辆的高程进行修正；
    从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，所述第一指示标志包括交通指示牌；
    基于所述目标指示标志的位置，对所述导航地图中车辆的位姿进行第一修正处理；
    根据第一修正处理后车辆的位姿和高程，确定所述导航地图和所述感知图像中除所述第一指示标志之外相匹配的其他类型的第二指示标志，其中，所述第二指示标志包括车道线和/或路灯杆；
    基于所述目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，分别与所述感知图像中的第一指示标志和第二指示标志的位置相匹配。
  2. 根据权利要求1所述的方法，其特征在于，基于所述目标指示标志的位置，对所述导航地图中车辆的位姿进行第一修正处理，包括：
    基于所述目标指示标志的位置，通过非线性优化算法对车辆的六自由度中的位置三自由度进行第一修正处理，以使所述导航地图和所述感知图像中的各个第一指示标志基于第一修正处理后的车辆位置在预设标准化平面上的投影误差小于第一预设距离。
  3. 根据权利要求1或2所述的方法，其特征在于，基于所述目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，分别与所述感知图像中的第一指示标志和第二指示标志的位置相匹配，包括：
    基于所述目标指示标志和相匹配的第二指示标志的位置，通过非线性优化算法对经过第一修正处理后的车辆位姿进行第二修正处理；
    基于第二修正处理后车辆的位姿，分别将所述导航地图和感知图像中的各个第一指示标志和各个第二指示标志投影到预设标准化平面；
    在所述预设标准化平面上，分别判断导航地图中投影后的第一指示标志和第二指示标志与感知图像中对应的第一指示标志和第二指示标志的投影距离是否均小于对应的第二预设距离；
    如果均小于第二预设距离，则确定所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，均与所述感知图像中第一指示标志和第二指示标志的位置相匹配；
    其中，第一指示标志和第二指示标志各自所对应的第二预设距离均小于各自所对应的第一预设距离。
  4. 根据权利要求1所述的方法，其特征在于，从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，包括：
    将感知图像中的各第一指示标志进行重建，并将重建后的第一指示标志与所述导航地图中的第一指示标志进行相似度比较，并将相似度值达到第一设定阈值的第一指示标志作为相匹配的目标指示标志。
  5. 根据权利要求1所述的方法，其特征在于，从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，包括：
    将所述导航地图中的第一指示标志投影到感知图像所在平面，并与所述感知图像中的第一指示标志进行相似度比较，将相似度值达到第二设定阈值的第一指示标志作为相匹配的目标指示标志。
  6. 根据权利要求1所述的方法，其特征在于，基于导航地图中所述当前位置对应的车道线信息，对所述预设定位装置提供的车辆的高程进行修正，包括：
    确定导航地图中所述当前位置对应的车道线的高程的平均值；
    将所述车道线的高程的平均值作为当前位置处车辆的高程，以对预设定位装置提供的车辆的高程进行修正。
  7. 根据权利要求1-6任一所述的方法，其特征在于，在对所述导航地图中的车辆位姿进行第二修正处理之后，所述方法还包括：
    基于第二修正处理后车辆的位姿更新所述导航地图中的显示内容；
    在车辆的行驶过程中，如果在连续设定帧数的感知图像中未获取到指示标志，和/或未获取到所述导航地图中的指示标志，则返回执行获取预设定位装置提供的车辆的当前位置的操作，以对车辆的位姿进行再次修正。
  8. 根据权利要求1-7任一所述的方法，其特征在于，所述方法还包括：
    对于预设定位装置提供的车辆的位置，如果检测出在所述导航地图中不存在对应的覆盖区域，则停止对所述导航地图的初始化操作，并将当前自动驾驶模式切换为手动驾驶模式。
  9. 一种导航地图在初始化时车辆位姿的修正装置，应用于自动驾驶，其特征在于，包括：
    高程修正模块，被配置为获取预设定位装置提供的车辆的当前位置，并基于导航地图中所述当前位置对应的车道线信息，对所述预设定位装置提供的车辆的高程进行修正；
    目标指示标志确定模块，被配置为从所述导航地图的各第一指示标志中选择与感知图像中的各第一指示标志相匹配的目标指示标志，所述第一指示标志包括交通指示牌；
    第一修正模块，被配置为基于所述目标指示标志的位置，对所述导航地图中车辆的位姿进行第一修正处理；
    第二指示标志确定模块，被配置为根据第一修正处理后车辆的位姿和高程，确定所述导航地图和所述感知图像中除所述第一指示标志之外相匹配的其他类型的第二指示标志，其中，所述第二指示标志包括车道线和/或路灯杆；
    第二修正模块，被配置为基于所述目标指示标志和相匹配的第二指示标志的位置，对第一修正处理后的车辆位姿进行第二修正处理，使得所述导航地图中第一指示标志和第二指示标志的位置根据所述第二修正处理后的车辆位姿，分别与所述感知图像中的第一指示标志和第二指示标志的位置相匹配。
  10. 根据权利要求9所述的装置，其特征在于，所述第一修正模块，具体被配置为：
    基于所述目标指示标志的位置，通过非线性优化算法对车辆的六自由度中的位置三自由度进行第一修正处理，以使所述导航地图和所述感知图像中的各个第一指示标志基于第一修正处理后的车辆位置在预设标准化平面上的投影误差小于第一预设距离。
PCT/CN2019/113480 2019-03-29 2019-10-26 一种导航地图在初始化时车辆位姿的修正方法和装置 WO2020199564A1 (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201910253289.0A CN111750882B (zh) 2019-03-29 2019-03-29 一种导航地图在初始化时车辆位姿的修正方法和装置
CN201910253289.0 2019-03-29

Publications (1)

Publication Number Publication Date
WO2020199564A1 true WO2020199564A1 (zh) 2020-10-08

Family

ID=72664885

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2019/113480 WO2020199564A1 (zh) 2019-03-29 2019-10-26 一种导航地图在初始化时车辆位姿的修正方法和装置

Country Status (2)

Country Link
CN (1) CN111750882B (zh)
WO (1) WO2020199564A1 (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112802097A (zh) * 2020-12-30 2021-05-14 深圳市慧鲤科技有限公司 一种定位方法、装置、电子设备及存储介质
CN113280822A (zh) * 2021-04-30 2021-08-20 北京觉非科技有限公司 一种车辆定位方法及定位装置
CN114419590A (zh) * 2022-01-17 2022-04-29 北京百度网讯科技有限公司 高精地图的验证方法、装置、设备以及存储介质

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113566817B (zh) * 2021-07-23 2024-03-08 北京经纬恒润科技股份有限公司 一种车辆定位方法及装置
CN114111817B (zh) * 2021-11-22 2023-10-13 武汉中海庭数据技术有限公司 基于slam地图与高精度地图匹配的车辆定位方法及系统

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20010023389A1 (en) * 2000-03-17 2001-09-20 Data Tron Co., Ltd Vehicle-mounted positional information indication system
CN103303313A (zh) * 2012-03-06 2013-09-18 北京四维图新科技股份有限公司 车辆控制方法和车辆控制系统
JP2014009993A (ja) * 2012-06-28 2014-01-20 Navitime Japan Co Ltd 情報処理システム、情報処理装置、サーバ、端末装置、情報処理方法、及びプログラム
CN105021201A (zh) * 2015-08-17 2015-11-04 武汉光庭信息技术有限公司 利用交通标示牌的坐标反推汽车自身位置的系统及方法
CN105718860A (zh) * 2016-01-15 2016-06-29 武汉光庭科技有限公司 基于驾驶安全地图及双目交通标志识别的定位方法及系统
CN106405601A (zh) * 2016-10-21 2017-02-15 北京汽车集团有限公司 车辆定位方法、装置和车辆
CN106842269A (zh) * 2017-01-25 2017-06-13 北京经纬恒润科技有限公司 定位方法及系统
CN107643086A (zh) * 2016-07-22 2018-01-30 北京四维图新科技股份有限公司 一种车辆定位方法、装置及系统
CN108303103A (zh) * 2017-02-07 2018-07-20 腾讯科技（深圳）有限公司 目标车道的确定方法和装置
CN109141444A (zh) * 2018-08-28 2019-01-04 北京三快在线科技有限公司 定位方法、装置、存储介质及移动设备

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09152348A (ja) * 1995-12-01 1997-06-10 Pioneer Electron Corp カーナビゲーション装置
JP4377284B2 (ja) * 2004-06-02 2009-12-02 株式会社ザナヴィ・インフォマティクス 車載ナビゲーション装置
US9342888B2 (en) * 2014-02-08 2016-05-17 Honda Motor Co., Ltd. System and method for mapping, localization and pose correction of a vehicle based on images
KR101843773B1 (ko) * 2015-06-30 2018-05-14 엘지전자 주식회사 차량 운전 보조 장치, 차량용 디스플레이 장치 및 차량
CN105783936B (zh) * 2016-03-08 2019-09-24 武汉中海庭数据技术有限公司 用于自动驾驶中的道路标识制图及车辆定位方法及系统
CN106651953B (zh) * 2016-12-30 2019-10-18 山东大学 一种基于交通指示牌的车辆位姿估计方法
CN107144285B (zh) * 2017-05-08 2020-06-26 深圳地平线机器人科技有限公司 位姿信息确定方法、装置和可移动设备
CN107389088B (zh) * 2017-05-27 2020-11-17 纵目科技（上海）股份有限公司 车载惯性导航的误差修正方法、装置、介质及设备
US10551509B2 (en) * 2017-06-30 2020-02-04 GM Global Technology Operations LLC Methods and systems for vehicle localization
CN107328410B (zh) * 2017-06-30 2020-07-28 百度在线网络技术（北京）有限公司 用于定位自动驾驶车辆的方法和汽车电脑
CN107957266B (zh) * 2017-11-16 2020-09-01 北京小米移动软件有限公司 定位方法、装置及存储介质
CN108090456B (zh) * 2017-12-27 2020-06-19 北京初速度科技有限公司 识别车道线模型的训练方法、车道线识别方法及装置
CN109405824A (zh) * 2018-09-05 2019-03-01 武汉契友科技股份有限公司 一种适用于智能网联汽车的多源感知定位系统

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20010023389A1 (en) * 2000-03-17 2001-09-20 Data Tron Co., Ltd Vehicle-mounted positional information indication system
CN103303313A (zh) * 2012-03-06 2013-09-18 北京四维图新科技股份有限公司 车辆控制方法和车辆控制系统
JP2014009993A (ja) * 2012-06-28 2014-01-20 Navitime Japan Co Ltd 情報処理システム、情報処理装置、サーバ、端末装置、情報処理方法、及びプログラム
CN105021201A (zh) * 2015-08-17 2015-11-04 武汉光庭信息技术有限公司 利用交通标示牌的坐标反推汽车自身位置的系统及方法
CN105718860A (zh) * 2016-01-15 2016-06-29 武汉光庭科技有限公司 基于驾驶安全地图及双目交通标志识别的定位方法及系统
CN107643086A (zh) * 2016-07-22 2018-01-30 北京四维图新科技股份有限公司 一种车辆定位方法、装置及系统
CN106405601A (zh) * 2016-10-21 2017-02-15 北京汽车集团有限公司 车辆定位方法、装置和车辆
CN106842269A (zh) * 2017-01-25 2017-06-13 北京经纬恒润科技有限公司 定位方法及系统
CN108303103A (zh) * 2017-02-07 2018-07-20 腾讯科技（深圳）有限公司 目标车道的确定方法和装置
CN109141444A (zh) * 2018-08-28 2019-01-04 北京三快在线科技有限公司 定位方法、装置、存储介质及移动设备

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112802097A (zh) * 2020-12-30 2021-05-14 深圳市慧鲤科技有限公司 一种定位方法、装置、电子设备及存储介质
CN113280822A (zh) * 2021-04-30 2021-08-20 北京觉非科技有限公司 一种车辆定位方法及定位装置
CN113280822B (zh) * 2021-04-30 2023-08-22 北京觉非科技有限公司 一种车辆定位方法及定位装置
CN114419590A (zh) * 2022-01-17 2022-04-29 北京百度网讯科技有限公司 高精地图的验证方法、装置、设备以及存储介质
CN114419590B (zh) * 2022-01-17 2024-03-19 北京百度网讯科技有限公司 高精地图的验证方法、装置、设备以及存储介质

Also Published As

Publication number Publication date
CN111750882A (zh) 2020-10-09
CN111750882B (zh) 2022-05-27

Similar Documents

Publication Publication Date Title
WO2020199566A1 (zh) 一种导航地图与感知图像匹配关系的更新方法和装置
WO2020199565A1 (zh) 一种基于路灯杆的车辆位姿的修正方法和装置
WO2020199564A1 (zh) 一种导航地图在初始化时车辆位姿的修正方法和装置
WO2020192105A1 (zh) 一种车辆位姿的修正方法和装置
CN109509230B (zh) 一种应用于多镜头组合式全景相机的slam方法
CN110954113B (zh) 一种车辆位姿的修正方法和装置
WO2020042348A1 (zh) 自动驾驶导航地图的生成方法、系统、车载终端及服务器
CN109141444B (zh) 定位方法、装置、存储介质及移动设备
CN109426800B (zh) 一种车道线检测方法和装置
CN111551167B (zh) 一种基于无人机拍摄和语义分割的全局导航辅助方法
CN111854727B (zh) 一种车辆位姿的修正方法和装置
CN113008260B (zh) 一种导航信息处理方法、装置、电子设备及存储介质
CN111912416A (zh) 用于设备定位的方法、装置及设备
CN110766760A (zh) 用于相机标定的方法、装置、设备和存储介质
JP2020122785A (ja) Ｖ２ｘ情報融合を利用してｈｄマップをアップデートするための自車両位置決定を遂行する方法及び装置
CN115493602A (zh) 语义地图构建方法、装置及电子设备、存储介质
JP2022130588A (ja) 自動運転車両の位置合わせ方法、装置、電子機器及び車両
WO2024037487A1 (zh) 应用于车辆中的路径修正方法、装置及电子设备
CN111462243A (zh) 车载流媒体后视镜标定方法、系统及装置
CN113048988B (zh) 一种导航地图对应场景的变化元素检测方法及装置
CN114910085A (zh) 一种基于路政设施识别的车辆融合定位方法及装置
CN115112125A (zh) 自动驾驶车辆的定位方法、装置及电子设备、存储介质
CN111292382B (zh) 车载图像采集设备标定的方法和装置、电子设备、介质
TWM621494U (zh) 能指示正確車道的導航系統
CN114111817A (zh) 基于slam地图与高精度地图匹配的车辆定位方法及系统

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

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

Country of ref document: EP

Kind code of ref document: A1