CN112382116A - Method and system for acquiring point cloud map of vehicle - Google Patents

Method and system for acquiring point cloud map of vehicle Download PDF

Info

Publication number
CN112382116A
CN112382116A CN202011263911.5A CN202011263911A CN112382116A CN 112382116 A CN112382116 A CN 112382116A CN 202011263911 A CN202011263911 A CN 202011263911A CN 112382116 A CN112382116 A CN 112382116A
Authority
CN
China
Prior art keywords
vehicle
coordinates
obstacle
road section
rtk
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202011263911.5A
Other languages
Chinese (zh)
Inventor
栾金鹿
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang Geely Holding Group Co Ltd
Geely Automobile Research Institute Ningbo Co Ltd
Original Assignee
Zhejiang Geely Holding Group Co Ltd
Geely Automobile Research Institute Ningbo Co Ltd
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 Zhejiang Geely Holding Group Co Ltd, Geely Automobile Research Institute Ningbo Co Ltd filed Critical Zhejiang Geely Holding Group Co Ltd
Priority to CN202011263911.5A priority Critical patent/CN112382116A/en
Publication of CN112382116A publication Critical patent/CN112382116A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • G08G1/0962Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0967Systems involving transmission of highway information, e.g. weather, speed limits
    • G08G1/096708Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30Map- or contour-matching
    • G01C21/32Structuring or formatting of map data
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/123Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams
    • G08G1/133Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams within the vehicle ; Indicators inside the vehicles or at stops
    • G08G1/137Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams within the vehicle ; Indicators inside the vehicles or at stops the indicator being in the form of a map

Landscapes

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

Abstract

本发明提供一种用于获取车辆的点云地图的方法和系统,涉及车辆的自动驾驶技术领域。方法包括:采集所述车辆的预设行驶路线上是否存在GPS和/或RTK信号丢失的障碍路段;若是,在所述车辆与所述障碍路段的起点之间的距离大于预设值时,采用RTK获取所述车辆在所述预设行驶路线上的绝对坐标,及采用SLAM获取所述车辆在所述预设行驶路线上的相对坐标;根据所述绝对坐标和所述相对坐标得到所述车辆在所述障碍路段的行驶轨迹从而得到所述车辆在所述预设行驶路线上的点云地图。本发明提供的方法可以在局部路段无GPS和RTK信号的场景下为自动驾驶车辆提供点云地图。

Figure 202011263911

The invention provides a method and a system for acquiring a point cloud map of a vehicle, and relates to the technical field of automatic driving of vehicles. The method includes: collecting whether there is an obstacle road segment with GPS and/or RTK signal loss on the preset driving route of the vehicle; if so, when the distance between the vehicle and the starting point of the obstacle road segment is greater than a preset value, adopting RTK obtains the absolute coordinates of the vehicle on the preset travel route, and uses SLAM to obtain the relative coordinates of the vehicle on the preset travel route; obtain the vehicle according to the absolute coordinates and the relative coordinates A point cloud map of the vehicle on the preset driving route is obtained from the driving track of the obstacle road section. The method provided by the present invention can provide a point cloud map for an automatic driving vehicle in a scene where there is no GPS and RTK signals in a local road section.

Figure 202011263911

Description

Method and system for acquiring point cloud map of vehicle
Technical Field
The invention relates to the technical field of intelligent driving of vehicles, in particular to a method and a system for acquiring a point cloud map of a vehicle.
Background
The automatic driving technology has been more and more emphasized by people, wherein the high-precision positioning technology (reaching centimeter level) is the core and basic function of automatic driving, the automatic driving vehicle cannot walk without being positioned, the automatic driving vehicle without being positioned with high precision has no safety guarantee, and point cloud positioning is the most accurate positioning means at present and is not neglected.
The premise of point cloud positioning is to create a high-precision point cloud map, and to provide global absolute coordinates for positioning, in an open scene, the global absolute coordinates can be rapidly acquired by generally using an RTK (real-time kinematic carrier phase difference technology), but in a scene without RTK signals or poor RTK signals, the global coordinates cannot be acquired, so that the point cloud map cannot be created, and the point cloud map cannot be used for point cloud positioning.
Disclosure of Invention
It is an object of a first aspect of the invention to provide a method that can provide a point cloud map for autonomous vehicles in a scenario where local road segments are free of GPS and RTK signals.
It is a further object of the first aspect of the invention to provide a method of providing an accurate point cloud map for an autonomous vehicle.
It is an object of a second aspect of the present invention to provide a system that can provide a point cloud map for autonomous vehicles in a scenario where there are no GPS and RTK signals on local road segments.
According to the first aspect described above, the present invention provides a method for acquiring a point cloud map of a vehicle, comprising:
acquiring whether a GPS and/or RTK signal lost obstacle road section exists on a preset driving route of the vehicle;
if so, when the distance between the vehicle and the starting point of the obstacle road section is larger than a preset value, acquiring an absolute coordinate of the vehicle on the preset running route by adopting RTK, and acquiring a relative coordinate of the vehicle on the preset running route by adopting SLAM;
and obtaining the driving track of the vehicle on the obstacle road section according to the absolute coordinates and the relative coordinates so as to obtain a point cloud map of the vehicle on the preset driving route.
Optionally, obtaining the driving track of the vehicle on the obstacle road section according to the absolute coordinate and the relative coordinate to obtain the point cloud map of the vehicle on the preset driving route includes:
aligning the absolute coordinates and the relative coordinates according to a timestamp to obtain a conversion matrix on a track with a distance between the vehicle and the starting point of the obstacle road section being greater than zero and less than or equal to the preset value;
and on the obstacle road section, converting the absolute coordinates and the relative coordinates according to the conversion matrix to obtain a driving track of the vehicle on the obstacle road section so as to obtain a point cloud map of the vehicle on the preset driving route.
Optionally, on a track where a distance between the vehicle and the start point of the obstacle road segment is greater than zero and less than or equal to the preset value, aligning the absolute coordinate and the relative coordinate according to a timestamp to obtain a transformation matrix includes:
and aligning the absolute coordinates and the relative coordinates according to a timestamp to enable the coordinates given by the absolute coordinates and the relative coordinates at the same time to be at the same position, thereby obtaining the conversion matrix.
Optionally, the following method is adopted to obtain the transformation matrix:
selecting a certain track point P of the vehicle on a track with the distance between the vehicle and the starting point of the obstacle road section being larger than zero and smaller than the preset value;
the absolute coordinates are: prtk=(x,y);
The relative coordinates are: pslam=(u,k);
Then
Figure BDA0002775507580000021
Convert the matrix into
Figure BDA0002775507580000022
Optionally, on the obstacle section, converting the absolute coordinates and the relative coordinates according to the conversion matrix to obtain a driving track of the vehicle on the obstacle section so as to obtain a point cloud map of the vehicle on the preset driving route includes:
and converting the absolute coordinates on the obstacle road section according to the conversion matrix to obtain the running track of the vehicle on the obstacle road section based on the relative coordinates of the track, wherein the distance between the vehicle and the starting point of the obstacle road section is larger than zero and smaller than or equal to the preset value.
Optionally, the obstacle section comprises a tunnel and an underground garage.
Optionally, when the distance between the vehicle and the starting point of the obstacle road segment is greater than a preset value, acquiring the absolute coordinate of the vehicle on the preset driving route by using RTK, and acquiring the relative coordinate of the vehicle on the preset driving route by using SLAM includes:
stopping the vehicle at a certain point where the distance between the vehicle and the starting point of the obstacle section is greater than a preset value, and starting or restarting the RTK and the SLAM to synchronize the RTK with the operation starting point of the SLAM.
Optionally, the selection of the preset value is required to be combined with the running speed of the vehicle.
Optionally, the preset value is 1 km.
According to the second aspect, the invention further provides a system for acquiring a point cloud map of a vehicle, which comprises a control device, wherein the control device comprises a memory and a processor, the memory stores a control program, and the control program is used for realizing the method for acquiring the point cloud map of the vehicle when being executed by the processor.
The method for acquiring the point cloud map of the vehicle is generally suitable for automatically driving the vehicle, the vehicle plans a driving route according to the point cloud map provided by the GPS or the RTK on a road section with good GPS or RTK signals, the GPS and RTK signals are monitored by a sensor on the vehicle in the whole process of driving the vehicle, when an obstacle road section with lost GPS and/or RTK signals on the current driving route of the vehicle is predicted, an absolute coordinate and a relative coordinate are acquired by two means when the distance between the vehicle and the starting point of the obstacle road section is larger than a preset value, namely the absolute coordinate on the preset driving route is acquired by the RTK and the relative coordinate on the preset driving route is acquired by an SLAM (synchronous positioning and mapping), the accurate relative coordinate of the vehicle at each moment can be acquired by the SLAM, and then the driving track of the vehicle on the obstacle road section is acquired according to the absolute coordinate and the relative coordinate, so that the point cloud driving track of the vehicle on the preset route The map can be used for supplementing the obstacle road section, the problem that the point cloud map cannot be created under the condition of losing RTK and/or GPS scenes is solved, the using range of point cloud positioning is expanded, and the robustness of the point cloud positioning is improved.
Further, before the vehicle enters the obstacle section, it is necessary to ensure that each coordinate point to be converted is in a one-to-one correspondence relationship as much as possible when performing coordinate conversion, that is, it is considered that the information values output at the same time through the RTK and the SLAM represent the same position, so that it is necessary to time-align the relative coordinate output by the SLAM and the absolute coordinate output by the RTK according to their respective time stamps, and use the relative coordinate output by the SLAM and the absolute coordinate output by the RTK after time alignment as the same position value at the same time, and based on this data pair, it is possible to calculate a conversion matrix between the local coordinate and the global coordinate
Figure BDA0002775507580000031
Therefore, the accuracy of the finally obtained point cloud map can be ensured.
The above and other objects, advantages and features of the present invention will become more apparent to those skilled in the art from the following detailed description of specific embodiments thereof, taken in conjunction with the accompanying drawings.
Drawings
Some specific embodiments of the invention will be described in detail hereinafter, by way of illustration and not limitation, with reference to the accompanying drawings. The same reference numbers in the drawings identify the same or similar elements or components. Those skilled in the art will appreciate that the drawings are not necessarily drawn to scale. In the drawings:
FIG. 1 is a block flow diagram of a method for obtaining a point cloud map of a vehicle, according to one embodiment of the invention;
FIG. 2 is a block flow diagram of a method for obtaining a point cloud map of a vehicle, according to another embodiment of the invention;
fig. 3 is a block diagram of a system for acquiring a point cloud map of a vehicle according to one embodiment of the present invention.
Detailed Description
Reference will now be made in detail to embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein like or similar reference numerals refer to the same or similar elements or elements having the same or similar function throughout. The embodiments described below with reference to the drawings are illustrative and intended to be illustrative of the invention and are not to be construed as limiting the invention.
FIG. 1 is a block flow diagram of a method for obtaining a point cloud map of a vehicle, according to one embodiment of the invention. As shown in fig. 1, the present invention provides a method for obtaining a point cloud map of a vehicle, generally comprising:
s10: acquiring whether a GPS and/or RTK signal lost obstacle road section exists on a preset driving route of a vehicle;
s20: if so, when the distance between the vehicle and the starting point of the obstacle road section is larger than a preset value, acquiring absolute coordinates of the vehicle on a preset driving route by adopting RTK (real time kinematic), and acquiring relative coordinates of the vehicle on the preset driving route by adopting SLAM (SLAM);
s30: and obtaining the driving track of the vehicle on the obstacle road section according to the absolute coordinates and the relative coordinates so as to obtain a point cloud map of the vehicle on a preset driving route.
The method for acquiring the point cloud map of the vehicle provided by the embodiment is generally suitable for an automatic driving vehicle, the vehicle plans a driving route according to the point cloud map provided by the GPS or RTK on a road section with good GPS or RTK signals, the GPS and RTK signals are monitored by a sensor on the vehicle in the whole process of driving the vehicle, when an obstacle road section with lost GPS and/or RTK signals on the current driving route of the vehicle is predicted, an absolute coordinate and a relative coordinate are acquired by two means when the distance between the vehicle and the starting point of the obstacle road section is greater than a preset value, namely, the absolute coordinate on the preset driving route is acquired by the RTK and the relative coordinate on the preset driving route is acquired by an SLAM (synchronous positioning and mapping), the accurate relative coordinate of the vehicle at each moment can be acquired by the SLAM, and then the driving track of the vehicle on the obstacle road section is acquired according to the absolute coordinate and the relative coordinate, so that the points of the vehicle on the The cloud map can be used for supplementing the obstacle road section, the problem that the point cloud map cannot be created under the condition that RTK and/or GPS are lost is solved, the using range of point cloud positioning is expanded, and the robustness of point cloud positioning is improved.
In a preferred embodiment, the vehicle sequentially passes through the RTK signal good section, the RTK signal-free section (obstacle section), and the RTK signal good section according to the point cloud map created as described above.
Fig. 2 is a block flow diagram of a method for obtaining a point cloud map of a vehicle according to another embodiment of the invention. As shown in fig. 2, in a specific embodiment, obtaining a driving track of the vehicle on the obstacle section according to the absolute coordinates and the relative coordinates to obtain a point cloud map of the vehicle on the preset driving route includes:
s31: aligning the absolute coordinates and the relative coordinates according to the timestamp to obtain a conversion matrix on a track with the distance between the vehicle and the starting point of the obstacle road section being greater than zero and less than or equal to a preset value;
s32: and on the obstacle road section, converting the absolute coordinates and the relative coordinates according to the conversion matrix to obtain a driving track of the vehicle on the obstacle road section so as to obtain a point cloud map of the vehicle on a preset driving route.
In a more specific embodiment, on a trajectory where a distance between the vehicle and a start point of the obstacle section is greater than zero and less than or equal to a preset value, aligning the absolute coordinates and the relative coordinates according to the time stamp to obtain the conversion matrix includes:
and aligning the absolute coordinates and the relative coordinates according to the time stamp to enable the coordinates given by the absolute coordinates and the relative coordinates at the same time to be at the same position, thereby obtaining a conversion matrix.
Before the vehicle enters the obstacle section, it is necessary to ensure each waiting turn as much as possible when performing the coordinate conversionThe transformed coordinate points are in a one-to-one correspondence relationship, that is, the information values output at the same time through the RTK and the SLAM are considered to represent the same position, so that the relative coordinate output by the SLAM and the absolute coordinate output by the RTK need to be time-aligned according to the respective timestamps given by the relative coordinate output by the SLAM and the absolute coordinate output by the RTK, the relative coordinate output by the SLAM and the absolute coordinate output by the RTK after the time alignment are used to be considered as the same position value at the same time, and based on the data pair, the transformation matrix between the local coordinate and the
Figure BDA0002775507580000051
Therefore, the accuracy of the finally obtained point cloud map is ensured.
The automatic driving vehicle runs on a road section containing a normal GPS/RTK signal and a road section with an obstacle (lost GPS/RTK signal), executes a laser SLAM function, can acquire a transformation matrix from an SLAM local coordinate to an RTK global coordinate according to time alignment when the RTK signal is good, and can calculate the global coordinate corresponding to the SLAM local coordinate according to the transformation matrix when the vehicle enters the obstacle road section, thereby realizing the expected result of the invention.
In a further embodiment, the transformation matrix is obtained by:
selecting a certain track point P of the vehicle on a track with the distance between the vehicle and the starting point of the obstacle road section being larger than zero and smaller than a preset value;
the absolute coordinates are: prtk=(x,y);
The relative coordinates are: pslam=(u,k);
Then
Figure BDA0002775507580000061
From which a transformation matrix can be calculated according to the least squares method as
Figure BDA0002775507580000062
In a preferred embodiment, on the obstacle section, the step of converting the absolute coordinates and the relative coordinates according to the conversion matrix to obtain the driving track of the vehicle on the obstacle section so as to obtain the point cloud map of the vehicle on the preset driving route comprises the following steps:
and converting the absolute coordinates on the obstacle road section according to the conversion matrix to obtain the running track of the vehicle on the obstacle road section based on the relative coordinates of the track, wherein the distance between the vehicle and the starting point of the obstacle road section is greater than zero and less than or equal to a preset value.
After the transformation matrix is calculated, the accurate global coordinate of the relative coordinate obtained by SLAM under the condition that each point of the vehicle running has no GPS and/or RTK signal can be obtained, so that a point cloud map can be obtained.
In an alternative embodiment, the barrier section includes a tunnel and an underground garage.
In a further embodiment, the acquiring the absolute coordinates of the vehicle on the preset traveling route using the RTK and the acquiring the relative coordinates of the vehicle on the preset traveling route using the SLAM when the distance between the vehicle and the start point of the obstacle section is greater than a preset value includes:
and stopping the vehicle at a certain point where the distance between the vehicle and the starting point of the obstacle road section is greater than a preset value, and starting or restarting the RTK and the SLAM to synchronize the RTK with the running starting point of the SLAM.
The vehicle provided by the embodiment is an automatic driving vehicle calibrated by a sensor, the sensor required on the vehicle comprises a laser radar, a GPS/RTK and an IMU sensor, a required SLAM program can be installed on the vehicle or additionally installed on the vehicle, and the function of SLAM offline data processing can be realized only by ensuring that corresponding setting is carried out according to the parameter alignment of the sensor of the vehicle.
Preferably, the selection of the preset value is combined with the running speed of the vehicle. The preset value is required to ensure that enough storage space is provided for holding sensor data, the area where the sensor data is located is a SLAM ready area, good GPS or RTK signals are required to be in the area, the vehicle can perform circular motion in a small range, and the aim is to enable the laser SLAM to form a closed loop.
In a specific embodiment, the preset value is 1 km.
In a specific embodiment, when the SLAM collects data online, the method works according to the following steps:
moving the vehicle to a SLAM ready area;
all sensors and control equipment of the vehicle are restarted to be used as a starting point of movement, and sensor data are recorded;
making the vehicle do small-range circular motion for 3-5 circles;
starting to drive according to the planned route until reaching the terminal point;
and finishing recording and storing.
In a specific embodiment, when the SLAM is offline, the method works according to the following steps:
starting a SLAM program;
the SLAM generates all track points by using the point cloud data and the IMU data;
extracting a track of the GPS/RTK data, and aligning the SLAM track with the GPS/RTK track according to the timestamp;
solving a rotating speed matrix by using the aligned SLAM coordinate and the GPS/RTK global coordinate;
extracting SLAM track points in the obstacle road section, and converting the SLAM track points into global coordinates by using a conversion matrix;
and replacing the finally calculated global track of the obstacle road section into the whole running track according to the corresponding relation of the time stamps, and completing all conversion to obtain the point cloud map.
Fig. 3 is a block diagram of a system for acquiring a point cloud map of a vehicle according to one embodiment of the present invention. As shown in fig. 3, the present invention further provides a system for acquiring a point cloud map of a vehicle, which generally includes a control device 10, the control device 10 includes a memory 11 and a processor 12, the memory 11 stores a control program, and the control program is executed by the processor 12 to implement the method for acquiring a point cloud map of a vehicle according to any one of the embodiments. The processor 12 may be a Central Processing Unit (CPU), a digital processing unit, or the like. The processor 12 transceives data through the communication interface. The memory 11 is used for storing programs executed by the processor. The memory 11 is any medium that can be used to carry or store desired program code in the form of instructions or data structures and that can be accessed by a computer, or a combination of memories. The above-described computing program may be downloaded from a computer-readable storage medium to a corresponding computing/processing device or to a computer or external storage device via a network (e.g., the internet, a local area network, a wide area network, and/or a wireless network).
Thus, it should be appreciated by those skilled in the art that while a number of exemplary embodiments of the invention have been illustrated and described in detail herein, many other variations or modifications consistent with the principles of the invention may be directly determined or derived from the disclosure of the present invention without departing from the spirit and scope of the invention. Accordingly, the scope of the invention should be understood and interpreted to cover all such other variations or modifications.

Claims (10)

1.一种用于获取车辆的点云地图的方法,其特征在于,包括:1. a method for obtaining the point cloud map of vehicle, is characterized in that, comprises: 采集所述车辆的预设行驶路线上是否存在GPS和/或RTK信号丢失的障碍路段;Collect whether there is an obstacle road section where GPS and/or RTK signals are lost on the preset driving route of the vehicle; 若是,在所述车辆与所述障碍路段的起点之间的距离大于预设值时,采用RTK获取所述车辆在所述预设行驶路线上的绝对坐标,及采用SLAM获取所述车辆在所述预设行驶路线上的相对坐标;If so, when the distance between the vehicle and the starting point of the obstacle road section is greater than a preset value, RTK is used to obtain the absolute coordinates of the vehicle on the preset driving route, and SLAM is used to obtain the vehicle at the location. relative coordinates on the preset driving route; 根据所述绝对坐标和所述相对坐标得到所述车辆在所述障碍路段的行驶轨迹从而得到所述车辆在所述预设行驶路线上的点云地图。The driving track of the vehicle on the obstacle road section is obtained according to the absolute coordinates and the relative coordinates, so as to obtain a point cloud map of the vehicle on the preset driving route. 2.根据权利要求1所述的方法,其特征在于,根据所述绝对坐标和所述相对坐标得到所述车辆在所述障碍路段的行驶轨迹从而得到所述车辆在所述预设行驶路线上的点云地图包括:2 . The method according to claim 1 , wherein the driving trajectory of the vehicle on the obstacle road section is obtained according to the absolute coordinates and the relative coordinates, so as to obtain the vehicle on the preset driving route. 3 . The point cloud map includes: 在所述车辆与所述障碍路段的起点之间的距离大于零且小于等于所述预设值的轨迹上,根据时间戳对齐所述绝对坐标和所述相对坐标得到转换矩阵;On a trajectory where the distance between the vehicle and the starting point of the obstacle road segment is greater than zero and less than or equal to the preset value, aligning the absolute coordinates and the relative coordinates according to the timestamp to obtain a transformation matrix; 在所述障碍路段上,根据所述转换矩阵将所述绝对坐标与所述相对坐标转换得到所述车辆在所述障碍路段的行驶轨迹从而得到所述车辆在所述预设行驶路线上的点云地图。On the obstacle road section, the absolute coordinates and the relative coordinates are converted according to the transformation matrix to obtain the driving track of the vehicle on the obstacle road section, so as to obtain the point of the vehicle on the preset driving route Cloud map. 3.根据权利要求2所述的方法,其特征在于,在所述车辆与所述障碍路段的起点之间的距离大于零且小于等于所述预设值的轨迹上,根据时间戳对齐所述绝对坐标和所述相对坐标得到转换矩阵包括:3 . The method according to claim 2 , wherein, on a trajectory where the distance between the vehicle and the starting point of the obstacle road segment is greater than zero and less than or equal to the preset value, aligning the The absolute coordinates and the relative coordinates get the transformation matrix including: 根据时间戳对齐所述绝对坐标和所述相对坐标使两者在同一时间给出的坐标为同一位置,从而得到所述转换矩阵。Align the absolute coordinates and the relative coordinates according to the timestamp so that the coordinates given by the two at the same time are the same position, so as to obtain the transformation matrix. 4.根据权利要求3所述的方法,其特征在于,采用以下方法得到转换矩阵:4. method according to claim 3, is characterized in that, adopts following method to obtain conversion matrix: 在所述车辆与所述障碍路段的起点之间的距离大于零且小于所述预设值的轨迹上,选取所述车辆的某一轨迹点P;On a trajectory where the distance between the vehicle and the starting point of the obstacle section is greater than zero and less than the preset value, select a certain trajectory point P of the vehicle; 所述绝对坐标为:Prtk=(x,y);The absolute coordinates are: P rtk =(x, y); 所述相对坐标为:Pslam=(u,k);The relative coordinates are: P slam =(u, k);
Figure FDA0002775507570000011
转换矩阵为
Figure FDA0002775507570000012
but
Figure FDA0002775507570000011
The transformation matrix is
Figure FDA0002775507570000012
5.根据权利要求2所述的方法,其特征在于,在所述障碍路段上,根据所述转换矩阵将所述绝对坐标与所述相对坐标转换得到所述车辆在所述障碍路段的行驶轨迹从而得到所述车辆在所述预设行驶路线上的点云地图包括:5 . The method according to claim 2 , wherein, on the obstacle road section, the absolute coordinate and the relative coordinate are converted according to the transformation matrix to obtain the driving trajectory of the vehicle on the obstacle road section. 6 . Thus, the point cloud map of the vehicle on the preset driving route includes: 基于所述车辆与所述障碍路段的起点之间的距离大于零且小于等于所述预设值的轨迹的相对坐标,按照所述转换矩阵将所述障碍路段上的所述绝对坐标转换得到所述车辆在所述障碍路段的行驶轨迹。Based on the relative coordinates of the trajectory where the distance between the vehicle and the starting point of the obstacle road segment is greater than zero and less than or equal to the preset value, the absolute coordinates on the obstacle road segment are converted according to the transformation matrix to obtain the obtained The driving track of the vehicle on the obstacle road section. 6.根据权利要求1所述的方法,其特征在于,所述障碍路段包括隧道和地下车库。6. The method of claim 1, wherein the obstacle road section includes a tunnel and an underground garage. 7.根据权利要求1所述的方法,其特征在于,在所述车辆与所述障碍路段的起点之间的距离大于预设值时,采用RTK获取所述车辆在所述预设行驶路线上的绝对坐标,及采用SLAM获取所述车辆在所述预设行驶路线上的相对坐标包括:7 . The method according to claim 1 , wherein when the distance between the vehicle and the starting point of the obstacle road section is greater than a preset value, RTK is used to obtain the vehicle on the preset driving route. 8 . The absolute coordinates of and using SLAM to obtain the relative coordinates of the vehicle on the preset driving route include: 在所述车辆与所述障碍路段的起点之间的距离大于预设值的某个点停止所述车辆,开启或重启所述RTK和所述SLAM使所述RTK与所述SLAM的运行起点同步。Stop the vehicle at a point where the distance between the vehicle and the starting point of the obstacle section is greater than a preset value, and start or restart the RTK and the SLAM to synchronize the RTK with the operating starting point of the SLAM . 8.根据权利要求1所述的方法,其特征在于,所述预设值的选定需要结合所述车辆的行驶速度。8 . The method according to claim 1 , wherein the selection of the preset value needs to be combined with the traveling speed of the vehicle. 9 . 9.根据权利要求8所述的方法,其特征在于,所述预设值为1km。9. The method according to claim 8, wherein the preset value is 1 km. 10.一种用于获取车辆的点云地图的系统,其特征在于,包括控制装置,所述控制装置包括存储器和处理器,所述存储器内存储有控制程序,所述控制程序被所述处理器执行时用于实现根据权利要求1-9中任一项所述的获取车辆的点云地图的方法。10. A system for acquiring a point cloud map of a vehicle, comprising a control device, the control device comprising a memory and a processor, wherein the memory stores a control program, and the control program is processed by the When the controller is executed, the method for obtaining a point cloud map of a vehicle according to any one of claims 1-9 is implemented.
CN202011263911.5A 2020-11-12 2020-11-12 Method and system for acquiring point cloud map of vehicle Pending CN112382116A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011263911.5A CN112382116A (en) 2020-11-12 2020-11-12 Method and system for acquiring point cloud map of vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011263911.5A CN112382116A (en) 2020-11-12 2020-11-12 Method and system for acquiring point cloud map of vehicle

Publications (1)

Publication Number Publication Date
CN112382116A true CN112382116A (en) 2021-02-19

Family

ID=74583457

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011263911.5A Pending CN112382116A (en) 2020-11-12 2020-11-12 Method and system for acquiring point cloud map of vehicle

Country Status (1)

Country Link
CN (1) CN112382116A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114715184A (en) * 2022-03-07 2022-07-08 清华大学 Intelligent networking automobile hierarchical decision-making and control method and device based on automobile cloud cooperation

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107577646A (en) * 2017-08-23 2018-01-12 上海莫斐信息技术有限公司 A kind of high-precision track operation method and system
CN108917761A (en) * 2018-05-07 2018-11-30 西安交通大学 A kind of accurate positioning method of unmanned vehicle in underground garage
CN110187375A (en) * 2019-06-27 2019-08-30 武汉中海庭数据技术有限公司 A kind of method and device improving positioning accuracy based on SLAM positioning result
CN111272181A (en) * 2020-02-06 2020-06-12 北京京东乾石科技有限公司 Method, device, equipment and computer readable medium for constructing map
US20200193170A1 (en) * 2018-12-13 2020-06-18 Ordnance Survey Limited Determining Position Data
CN111578957A (en) * 2020-05-07 2020-08-25 泉州装备制造研究所 A pure tracking method for intelligent vehicles based on 3D point cloud map positioning
CN111681163A (en) * 2020-04-23 2020-09-18 北京三快在线科技有限公司 Method and device for constructing point cloud map, electronic equipment and storage medium
CN111812658A (en) * 2020-07-09 2020-10-23 北京京东乾石科技有限公司 Position determination method, device, system and computer readable storage medium

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107577646A (en) * 2017-08-23 2018-01-12 上海莫斐信息技术有限公司 A kind of high-precision track operation method and system
CN108917761A (en) * 2018-05-07 2018-11-30 西安交通大学 A kind of accurate positioning method of unmanned vehicle in underground garage
US20200193170A1 (en) * 2018-12-13 2020-06-18 Ordnance Survey Limited Determining Position Data
CN110187375A (en) * 2019-06-27 2019-08-30 武汉中海庭数据技术有限公司 A kind of method and device improving positioning accuracy based on SLAM positioning result
CN111272181A (en) * 2020-02-06 2020-06-12 北京京东乾石科技有限公司 Method, device, equipment and computer readable medium for constructing map
CN111681163A (en) * 2020-04-23 2020-09-18 北京三快在线科技有限公司 Method and device for constructing point cloud map, electronic equipment and storage medium
CN111578957A (en) * 2020-05-07 2020-08-25 泉州装备制造研究所 A pure tracking method for intelligent vehicles based on 3D point cloud map positioning
CN111812658A (en) * 2020-07-09 2020-10-23 北京京东乾石科技有限公司 Position determination method, device, system and computer readable storage medium

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114715184A (en) * 2022-03-07 2022-07-08 清华大学 Intelligent networking automobile hierarchical decision-making and control method and device based on automobile cloud cooperation

Similar Documents

Publication Publication Date Title
US11802769B2 (en) Lane line positioning method and apparatus, and storage medium thereof
Milanés et al. Autonomous vehicle based in cooperative GPS and inertial systems
US11915440B2 (en) Generation of structured map data from vehicle sensors and camera arrays
CN111176270B (en) Positioning using dynamic landmarks
KR20190082071A (en) Method, apparatus, and computer readable storage medium for updating electronic map
US11579628B2 (en) Method for localizing a vehicle
CN105841708A (en) Vehicle navigation and positioning track matching method based on path tracing
CN101183010A (en) A positioning subsystem and positioning method of a vehicle ad hoc network system
US20220398825A1 (en) Method for generating 3d reference points in a map of a scene
KR20220024791A (en) Method and apparatus for determining the trajectory of a vehicle
US20190331496A1 (en) Locating a vehicle
CN113311452B (en) Positioning method and system based on multiple sensors
CN114061611A (en) Target object positioning method, apparatus, storage medium and computer program product
CN112382116A (en) Method and system for acquiring point cloud map of vehicle
CN119348615A (en) A memory parking positioning method and related device
CN111504332A (en) Method for determining the position of a vehicle in a digital map
CN114624754B (en) Automatic driving positioning device and method for space-time positioning and near-field compensation
CN113390422B (en) Automobile positioning method and device and computer storage medium
CN112241016B (en) Method and device for determining geographic coordinates of parking map
El-Sheimy An expert knowledge GPS/INS system for mobile mapping and GIS applications
RU2772620C1 (en) Creation of structured map data with vehicle sensors and camera arrays
CN110907978A (en) Method and device for cloud online optimization of inertial navigation parameters
CN115790595B (en) Unmanned aerial vehicle fault-tolerant navigation method and system based on combination of communication and perception
US20240300528A1 (en) Systems and methods for estimating a state for positioning autonomous vehicles transitioning between different environments
CN119164408A (en) Unmanned vehicle positioning method, system, terminal and storage medium

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20210219

RJ01 Rejection of invention patent application after publication