Position acquisition method, system and movable platform
By acquiring and correcting the position of laser point cloud data on the movable platform of the driverless car, the problem of low accuracy of the driverless car map is solved, and the accuracy and safety of the map are improved.
Patent Information
- Application Number
- CN201980034308.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2019-08-30
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2039-08-30
AI Technical Summary
Self-driving cars need higher-precision maps when driving on the road. In the prior art, vehicle position data errors affect the accuracy of high-precision maps.
Provide a pose acquisition method and system, and use the first detection device on the movable platform to obtain laser point cloud data and the second detection device to obtain pose information, and calculate the relative pose relationship through the laser point cloud data at two adjacent moments , correct the laser point cloud position at each moment to improve the accuracy of the position.
By improving the accuracy of position, the ability to build high-precision maps is enhanced to ensure the safety and accuracy of driverless cars.
Smart Images

Figure CN112204344B_ABST
Abstract
Description
Technical Field
[0001] The embodiments of the present application relate to the field of drone technology, and in particular to a posture acquisition method, system and movable platform. Background Art
[0002] Navigation electronic maps can be used to assist manual drivers in navigation when driving a car. The absolute coordinate accuracy of this navigation electronic map is about 10 meters. However, with the development of driverless technology, driverless cars will become a travel trend, and driverless cars need to know their exact position on the road when driving on the road. Often, the vehicle is only a few dozen centimeters away from the curb and the lane next to it, so a higher-precision map is needed. The absolute accuracy of this map is generally at the sub-meter level, that is, within 1 meter, and the lateral relative accuracy (for example, the relative position accuracy of lanes and lanes, lanes and lane lines) is often even higher. This high-precision map not only has high-precision coordinates, but also accurate road shapes, and the slope, curvature, heading, elevation, and roll data of each lane are also included to ensure the safety and accuracy of driverless cars driving on the road.
[0003] Therefore, high-precision maps are crucial for driverless cars. Currently, high-precision maps are reconstructed based on data collected by the camera while the vehicle is driving. However, due to errors in the vehicle's own posture data, this will affect the accuracy of the high-precision map. Summary of the invention
[0004] The embodiments of the present application provide a posture acquisition method, system and movable platform for improving the accuracy of posture acquisition to improve the accuracy of the established map.
[0005] In a first aspect, an embodiment of the present application provides a posture acquisition method, which is applied to a movable platform, wherein the movable platform is provided with a first detection device for acquiring laser point cloud data, and a second detection device for acquiring posture information; the method comprises:
[0006] Acquire laser point cloud data and the position and posture information at each moment obtained during the movement of the movable platform in the target area;
[0007] According to the laser point cloud data at two adjacent moments, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained;
[0008] According to the relative posture relationship of the laser point cloud at each two adjacent moments and the posture information at each moment, the posture of the laser point cloud at each moment is corrected to obtain the target posture of the laser point cloud at each moment.
[0009] In a second aspect, an embodiment of the present application provides a posture acquisition system, which is applied to a movable platform, and the system includes:
[0010] A first detection device, used to obtain laser point cloud data;
[0011] A second detection device is used to obtain position and posture information;
[0012] A processor is used to obtain the laser point cloud data at each moment obtained by the first detection device and the posture information at each moment obtained by the second detection device during the movement of the movable platform in the target area; obtain the relative posture relationship of the laser point clouds at two adjacent moments based on the laser point cloud data at two adjacent moments; correct the posture of the laser point cloud at each moment based on the relative posture relationship of the laser point clouds at two adjacent moments and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment.
[0013] In a third aspect, an embodiment of the present application provides a movable platform, including:
[0014] A first detection device, used to obtain laser point cloud data;
[0015] A second detection device is used to obtain position and posture information;
[0016] A processor is used to obtain the laser point cloud data at each moment obtained by the first detection device and the posture information at each moment obtained by the second detection device during the movement of the movable platform in the target area; obtain the relative posture relationship of the laser point clouds at two adjacent moments based on the laser point cloud data at two adjacent moments; correct the posture of the laser point cloud at each moment based on the relative posture relationship of the laser point clouds at two adjacent moments and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment.
[0017] In a fourth aspect, an embodiment of the present application provides a readable storage medium having a computer program stored thereon; when the computer program is executed, the posture acquisition method as described in the embodiment of the present application in the first aspect is implemented.
[0018] In a fifth aspect, an embodiment of the present application provides a program product, which includes a computer program, and the computer program is stored in a readable storage medium. At least one processor of a movable platform can read the computer program from the readable storage medium, and the at least one processor executes the computer program so that the movable platform implements the posture acquisition method described in the embodiment of the present application in the first aspect.
[0019] The posture acquisition method, system and movable platform provided in the embodiment of the present application obtain the laser point cloud data and posture information at each moment obtained during the movement of the movable platform in the target area; obtain the relative posture relationship of the laser point cloud at two adjacent moments according to the laser point cloud data at two adjacent moments; correct the posture of the laser point cloud at each moment according to the relative posture relationship of the laser point cloud at each adjacent moment and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment. Thereby, the target posture of the laser point cloud can more accurately reflect the actual posture of the movable platform, so as to improve the accuracy of the map when the map is established according to the target posture of the laser point cloud. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, a brief introduction will be given below to the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.
[0021] Figure 1 is a schematic architecture diagram of an autonomous driving vehicle 100 according to an embodiment of the present application;
[0022] Figure 2 A schematic diagram of an application scenario provided for an embodiment of the present application;
[0023] Figure 3 A flowchart of a method for obtaining a posture according to an embodiment of the present application;
[0024] Figure 4 A schematic diagram of the relative position relationship of the laser point cloud at each time provided in an embodiment of the present application;
[0025] Figure 5 A schematic diagram of the structure of a posture acquisition system provided in one embodiment of the present application;
[0026] Figure 6 A structural schematic diagram of a posture acquisition system provided in another embodiment of the present application;
[0027] Figure 7 A schematic diagram of the structure of a movable platform provided in one embodiment of the present application;
[0028] Figure 8 A schematic structural diagram of a movable platform provided in another embodiment of the present application. DETAILED DESCRIPTION
[0029] In order to make the purpose, technical solution and advantages of the embodiments of the present application clearer, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0030] It should be noted that when a component is said to be "fixed to" another component, it can be directly on the other component or there can be a central component. When a component is said to be "connected to" another component, it can be directly connected to the other component or there can be a central component at the same time.
[0031] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art to which this application belongs. The terms used herein in the specification of this application are only for the purpose of describing specific embodiments and are not intended to limit this application. The term "and / or" used herein includes any and all combinations of one or more of the related listed items.
[0032] In conjunction with the accompanying drawings, some embodiments of the present application are described in detail below. In the absence of conflict, the following embodiments and features in the embodiments can be combined with each other.
[0033] The embodiments of the present application provide a posture acquisition method, system and movable platform, wherein the movable platform may be a handheld phone, a handheld gimbal, a drone, an unmanned vehicle, an unmanned ship, a robot or an autonomous vehicle, etc.
[0034] The following description of the movable platform of the present application uses an autonomous vehicle as an example. Figure 1 It is a schematic architecture diagram of an autonomous driving vehicle 100 according to an embodiment of the present application.
[0035] The autonomous vehicle 100 may include a perception system 110 , a control system 120 , and a mechanical system 130 .
[0036] The perception system 110 is used to measure the state information of the autonomous driving vehicle 100, that is, the perception data of the autonomous driving vehicle 100. The perception data may represent the position information and / or state information of the autonomous driving vehicle 100, such as position, angle, speed, acceleration, and angular velocity. The perception system 110 may include, for example, at least one of a visual sensor (e.g., including multiple monocular or binocular vision devices), a laser radar, a millimeter-wave radar, an inertial measurement unit (IMU), a global navigation satellite system, a gyroscope, an ultrasonic sensor, an electronic compass, and a barometer. For example, the global navigation satellite system may be a global positioning system (GPS).
[0037] After the perception system 110 acquires the perception data, it can transmit the perception data to the control system 120. The control system 120 is used to make decisions based on the perception data to control how the autonomous driving vehicle 100 drives, such as: how fast to drive, or how much braking acceleration to brake, or whether to change lanes, or whether to turn left / right, etc. The control system 120 may include, for example: a computing platform, such as an on-board supercomputing platform, or at least one of a central processing unit, a distributed processing unit, or other processing function devices. The control system 120 may also include communication links for various data transmissions on the vehicle.
[0038] The control system 120 may output one or more control instructions to the mechanical system 130 according to the determined decision. The mechanical system 130 is used to control the autonomous driving vehicle 100 in response to one or more control instructions from the control system 120 to complete the above decision. For example, the mechanical system 130 may drive the wheels of the autonomous driving vehicle 100 to rotate, thereby providing power for the driving of the autonomous driving vehicle 100, wherein the rotation speed of the wheels may affect the speed of the unmanned vehicle. The mechanical system 130 may include, for example, at least one of a mechanical body engine / motor, a controlled wire control system, and the like.
[0039] It should be understood that the above-mentioned naming of the components of the unmanned vehicle is for identification purposes only and should not be construed as a limitation on the embodiments of the present application.
[0040] in, Figure 2 A schematic diagram of an application scenario provided in an embodiment of the present application, such as Figure 2As shown, the autonomous driving vehicle can travel on the ground, and in the process of driving on the ground in the target area, the autonomous driving vehicle can collect perception data (for example, through the above-mentioned perception system 110), and the perception data can include laser point cloud data, posture information and Vins posture data, etc., and then the laser point cloud is corrected in posture. The specific processing method can be referred to the description of the following embodiments of this application.
[0041] Figure 3 A flowchart of a method for obtaining a posture according to an embodiment of the present application is provided. Figure 3 As shown, the method of this embodiment can be applied to a mobile platform, and can also be applied to other electronic devices outside the mobile platform. The method includes:
[0042] S301, obtaining laser point cloud data and position information at each moment during the process of the movable platform moving in the target area.
[0043] S302: Obtain the relative position and posture relationship of the laser point clouds at two adjacent moments according to the laser point cloud data at two adjacent moments.
[0044] S303, correcting the pose of the laser point cloud at each moment according to the relative pose relationship of the laser point cloud at each two adjacent moments and the pose information at each moment, so as to obtain the target pose of the laser point cloud at each moment.
[0045] This embodiment is applied to a movable platform as an example. The movable platform is equipped with a first detection device and a second detection device, wherein the first detection device is used to obtain laser point cloud data, and the second detection device is used to obtain posture information. The posture information may be the posture information of the location of the second detection device. The second detection device may be arranged on the movable platform, so the posture information may be the posture information of the movable platform. Among them, when the movable platform moves in the target area, the first detection device obtains the laser point cloud data at each moment, and the second detection device obtains the posture information at each moment. Accordingly, the movable platform obtains the laser point cloud data at each moment obtained by the first detection device and the posture information at each moment obtained by the second detection device. The first detection device is, for example, a laser sensor, and the second detection device is, for example, a GPS.
[0046] If this embodiment is applied to other electronic devices other than the movable platform, the electronic device can obtain from the movable platform the laser point cloud data and posture information at each moment obtained during the movement of the movable platform in the target area, for example, by receiving the above information sent by the movable platform, or reading the above information from the storage device of the movable platform.
[0047] After the movable platform of this embodiment obtains the laser point cloud data and the pose information at each moment, the relative pose relationship of the laser point cloud at two adjacent moments is obtained according to the laser point cloud data at two adjacent moments, so that the relative pose relationship of the laser point cloud at two adjacent moments can be obtained. Taking the moments from moment 1 to moment 10 as an example, the relative pose relationship of the laser point cloud at 9 adjacent moments can be obtained accordingly. Optionally, the relative pose relationship includes at least one of the following: a rotation matrix and a displacement matrix.
[0048] After obtaining the relative posture relationship of the laser point cloud at each two adjacent moments, the posture of the laser point cloud at each moment is corrected according to the relative posture relationship of the laser point cloud at each two adjacent moments and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment.
[0049] The posture acquisition method provided in this embodiment obtains the laser point cloud data and posture information at each moment when the movable platform moves in the target area; obtains the relative posture relationship between the laser point clouds at two adjacent moments according to the laser point cloud data at two adjacent moments; and corrects the posture of the laser point cloud at each moment according to the relative posture relationship between the laser point clouds at two adjacent moments and the posture information at each moment to obtain the target posture of the laser point cloud at each moment. Thus, the target posture of the laser point cloud can more accurately reflect the actual posture of the movable platform, so as to improve the accuracy of the map when the map is established according to the target posture of the laser point cloud.
[0050] In some embodiments, after executing S303, a map is also created based on the target position and posture of the laser point cloud at each moment. Since the target position and posture of the laser point cloud at each moment are very close to the actual position and posture, the map created accordingly has higher accuracy.
[0051] In some embodiments, the corrected position and posture of the laser point cloud includes at least one of the following: height information and heading information. In this embodiment, the height information of the laser point cloud at each moment is corrected according to the relative position and posture relationship of the laser point cloud at each adjacent moment and the position and posture information at each moment, so that the height of the corrected laser point cloud is more accurate; or, the heading information of the laser point cloud at each moment is corrected according to the relative position and posture relationship of the laser point cloud at each adjacent moment and the position and posture information at each moment, so that the heading of the corrected laser point cloud is more accurate; or, the height information and heading information of the laser point cloud at each moment are corrected according to the relative position and posture relationship of the laser point cloud at each adjacent moment and the position and posture information at each moment, so that the height and heading of the corrected laser point cloud are more accurate.
[0052] In some embodiments, a possible implementation of S302 may include S3021 and S3022:
[0053] S3021. Obtain the estimated relative pose relationship of the laser point cloud at two adjacent moments.
[0054] S3022. Obtain a relative posture relationship of the laser point clouds at two adjacent moments according to the estimated relative posture relationship and the laser point cloud data at two adjacent moments.
[0055] In this embodiment, the estimated relative pose relationship of the laser point cloud at two adjacent moments is obtained, and then the relative pose relationship of the laser point cloud at two adjacent moments is obtained based on the estimated relative pose relationship of the laser point cloud at two adjacent moments and the laser point cloud data at two adjacent moments. Since the error of the obtained relative estimated pose relationship is large, the estimated relative pose relationship is corrected according to the laser point cloud data to obtain a more accurate relative pose relationship.
[0056] In some embodiments, a possible implementation of S3021 may include A1 and A2:
[0057] A1. Obtaining VINS posture data obtained by the movable platform at two adjacent moments;
[0058] A2. According to the VINS pose data at two adjacent moments, the estimated relative pose relationship of the laser point cloud at two adjacent moments is obtained.
[0059] In this embodiment, the movable platform is also provided with a third detection device, and the third detection device can obtain VINS posture data. When the movable platform moves in the target area, the third detection device can obtain VINS posture data at each moment, and accordingly, the movable platform can obtain VINS posture data at each moment obtained by the third detection device. Then, the movable platform obtains the VINS posture data of two adjacent moments, and the VINS posture data at each moment can represent the estimated posture of the laser point cloud at each moment, and according to the VINS posture data of two adjacent moments, the estimated relative posture relationship of the laser point cloud at the two moments is obtained.
[0060] In some embodiments, a possible implementation of S3021 may include B1 and B2:
[0061] B1. Estimate the laser point cloud data at the latter moment between the two adjacent moments according to the laser point cloud data at the former moment between the two adjacent moments and the estimated relative posture relationship.
[0062] B2. Obtaining the relative posture relationship of the laser point clouds at two adjacent moments based on the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship.
[0063] In this embodiment, taking two adjacent moments as moment 2 and moment 3 as an example, the laser point cloud data at moment 3 is estimated based on the estimated relative pose relationship between the laser point cloud data at moment 2 and the laser point cloud data at moment 3, and the estimated laser point cloud data at moment 3 may be different from the laser point cloud data at moment 3 acquired by the first detection device. Then, based on the estimated laser point cloud data at moment 3, the laser point cloud data at moment 3 acquired by the first detection device, and the above-mentioned estimated relative pose relationship, the relative pose relationship between the laser point clouds at moment 2 and moment 3 is obtained.
[0064] Optionally, a possible implementation method of the above B2 is: determine the relative pose relationship deviation based on the estimated laser point cloud data at the next moment and the laser point cloud data at the next moment acquired by the first detection device; and obtain the relative pose relationship of the laser point clouds at the two moments based on the relative pose relationship deviation and the estimated relative pose relationship.
[0065] Based on the estimated laser point cloud data at moment 3 and the laser point cloud data at moment 3 acquired by the first detection device, the estimated relative pose relationship between the laser point cloud data at moment 3 acquired by the first detection device is determined, which is called the relative pose relationship deviation. Then, based on the relative pose relationship deviation and the estimated relative pose relationship of the laser point clouds at moment 2 and moment 3, the relative pose relationship between the laser point clouds at moment 2 and moment 3 is acquired.
[0066] In some embodiments, a possible implementation method of obtaining the relative pose relationship of the laser point cloud at two adjacent moments based on the laser point cloud data at two adjacent moments may be: determining whether the laser point cloud data at two adjacent moments match based on the laser point cloud data at two adjacent moments. If they match, obtaining the relative pose relationship of the laser point cloud at two adjacent moments based on the laser point cloud data at two adjacent moments.
[0067] In this embodiment, according to the laser point cloud data at two adjacent moments, it is determined whether the laser point cloud data at two adjacent moments match. If they match, the above scheme of obtaining the relative position and posture relationship between the two adjacent moments according to the laser point cloud data at two adjacent moments is executed. If they do not match, the relative position and posture relationship between the two adjacent moments is not obtained. In this way, the relative position and posture relationship of the laser point cloud at two adjacent moments that match is obtained, and these relative position and posture relationships are more accurate, which is conducive to the subsequent correction of the laser point cloud.
[0068] Optionally, determine whether the laser point cloud data at two adjacent moments match, for example: obtain the distance of the normal vectors between the laser point cloud data at two adjacent moments, if the distance of the normal vectors is less than a preset value, then determine that the laser point cloud data at two adjacent moments match, if the distance of the normal vectors is greater than or equal to the preset value, then determine that the laser point cloud data at two adjacent moments do not match.
[0069] In some embodiments, a possible implementation of S303 may include S3031-S3033:
[0070] S3031. For any moment i, according to the posture information at each moment, determine the K moments whose posture is within a preset distance from the posture at moment i, where K, i is an integer greater than or equal to 1.
[0071] S3032. According to the laser point cloud data at the K moments and the laser point cloud data at the moment i, obtain the relative posture relationship between the laser point cloud at the moment i and each of the K moments.
[0072] S3033. Correct the pose of the laser point cloud at each moment according to the relative pose relationship between each moment i and each of the K moments and the relative pose relationship between the laser point clouds at two adjacent moments.
[0073] In this embodiment, taking any moment among the moments as an example, for example, moment i, i is an integer greater than or equal to 1, according to the posture information of each moment, the K moments within a preset distance from the posture of moment i are determined. Optionally, the posture information includes GPS data, and accordingly, what is determined is the K moments within a preset distance from the position of moment i. Then, according to the laser point cloud data of the K moments and the laser point cloud data of moment i, the relative posture relationship between moment i and the laser point cloud of each of the K moments is obtained, so as to obtain the posture of the laser point cloud of at least one moment within a preset distance from the posture of each moment in each moment.
[0074] Among them, the method of obtaining the relative posture relationship between the laser point cloud at time i and each of the K moments can refer to the method of obtaining the relative posture relationship between the laser point cloud at two adjacent moments in the above embodiment, which will not be repeated here.
[0075] Then, according to the relative posture relationship of the laser point cloud at each moment within the preset distance from the posture at each moment, and the relative posture relationship of the laser point cloud at each two adjacent moments obtained in S302, the posture of the laser point cloud at each moment is corrected, thereby improving the accuracy of the posture of the corrected laser point cloud.
[0076] In some embodiments, a possible implementation of S3033 may be C1:
[0077] C1. Correct the pose of the laser point cloud from time i to time j according to the relative pose relationship between the laser point cloud at time i and time j among the K moments, and the relative pose relationship between the laser point clouds at each adjacent moment between time i and time j.
[0078] In this embodiment, any moment among K moments is taken as an example, and the any moment is moment j. Assume that moment i is moment 1 and moment j is moment 4. Figure 4 As shown, according to the relative pose relationship between the laser point clouds at time 1 and time 4 (obtained through S3032), the relative pose relationship between the laser point clouds at time 1 and time 2, the relative pose relationship between the laser point clouds at time 2 and time 3, and the relative pose relationship between the laser point clouds at time 3 and time 4, the poses of the laser point clouds at time 1, time 2, time 3, and time 4 can be corrected.
[0079] In some embodiments, a possible implementation of C1 may include C11-C13:
[0080] C11. Determine the relative pose relationship error of the laser point cloud at time i and time j based on the relative pose relationship of the laser point cloud at each adjacent time from time i to time j, and the relative pose relationship of the laser point cloud at time i and time j.
[0081] C12. According to the relative posture relationship error, correct the relative posture relationship of the laser point cloud at each adjacent time from time i to time j.
[0082] C13. Correct the laser point cloud data from time i to time j according to the corrected relative position relationship of the laser point clouds at each adjacent time from time i to time j.
[0083] In this embodiment, taking time i as time 1 and time j as time 4 as an example, the relative posture relationship error of the laser point cloud at time i and time j is determined according to the relative posture relationship of the laser point cloud at time 1 and time 2, the posture relationship of the laser point cloud at time 2 and time 3, the posture relationship of the laser point cloud at time 3 and time 4, and the posture relationship of the laser point cloud at time 1 and time 4. For example: taking the relative posture relationship including at least one of the following items: rotation matrix and displacement matrix as an example, the relative posture relationship of the laser point cloud at time 1 and time 2, the relative posture relationship of the laser point cloud at time 2 and time 3, and the relative posture relationship of the laser point cloud at time 3 and time 4 are multiplied to obtain a calculated relative posture relationship of the laser point cloud at time 1 and time 4, and then the difference between the posture relationship of the laser point cloud at time 1 and time 4 and the calculated relative posture relationship of the laser point cloud at time 1 and time 4 is obtained, and the difference is called the relative posture relationship error of the laser point cloud at time 1 and time 4.
[0084] Then, according to the relative pose relationship error of the laser point cloud at time 1 and time 4, the relative pose relationship of the laser point cloud at time 1 and time 2, the relative pose relationship of the laser point cloud at time 2 and time 3, and the relative pose relationship of the laser point cloud at time 3 and time 4 are corrected. Then, according to the corrected relative pose relationship of the laser point cloud at time 1 and time 2, the corrected relative pose relationship of the laser point cloud at time 2 and time 3, and the corrected relative pose relationship of the laser point cloud at time 3 and time 4, the poses of the laser point clouds at time 1, time 2, time 3, and time 4 are corrected. After the corrected laser point cloud data is transformed according to the corrected relative pose relationship, it can be as identical as possible to the corresponding laser point cloud data.
[0085] Optionally, the relative pose relationship error between the laser point cloud at time i and time j is related to the relative pose relationship between the laser point cloud at time i and time j, and the relative pose relationship between the laser point cloud at each adjacent time from time i to time j. Therefore, the relative pose relationship error between the laser point cloud at time i and time j is minimized, and the relative pose relationship between the laser point cloud data at each adjacent time from time i to time j is corrected. Or,
[0086] Optionally, the sum of the relative pose relationship errors between the laser point cloud at time i and each of the K moments can be minimized, and the relative pose relationship between the laser point cloud data at each adjacent moment from time i to each of the K moments can be corrected. Or,
[0087] Optionally, the sum of the relative posture relationship errors between each moment i and the laser point cloud at each of the corresponding K moments can be minimized to correct the relative posture relationship of the laser point clouds at adjacent moments.
[0088] In some embodiments, a possible implementation of S3031 is: according to the posture information at each moment, determine all the moments within a preset distance from the posture at moment i, and all the moments are K moments. It should be noted that the value of i is different, and the value of K may also be different. Alternatively, the value of K is pre-set, and according to the posture information at each moment, determine the K moments within a preset distance from the posture at moment i. For example, K is pre-set to be 2. If the number of moments within a preset distance from the posture at moment i is greater than 2, then this embodiment obtains 2 of them to save processing resources.
[0089] In some embodiments, another possible implementation method of S3031 is: based on the posture information at each moment, determine that the moments whose posture is within a preset distance from the posture at moment i are M moments, where M is an integer greater than or equal to K; based on the laser point cloud data at moment i and the laser point cloud data at the M moments, determine the K moments in the M moments whose laser point cloud data respectively match the laser point cloud data at moment i.
[0090] In this embodiment, based on the posture information at each moment, all moments within a preset distance from the posture at moment i are determined, and all moments are M moments. Then, based on the laser point cloud data at the M moments and the laser point cloud data at moment i, the above-mentioned K moments at which the laser point cloud data matches the laser point cloud data at the above-mentioned moment i are determined. For example: all moments at which the laser point cloud data matches the laser point cloud data at moment i are determined as K moments. Alternatively, the value of K is pre-set, and the K moments at which the laser point cloud data matches the laser point cloud data at moment i from the M moments, for example: K is pre-set to 2, if there are 3 moments at which the laser point cloud data in the M laser point cloud data matches the laser point cloud data at moment i, then this embodiment obtains 2 of them to save processing resources.
[0091] Among them, how to determine the matching method of laser point cloud data at two moments can refer to the method of determining the matching method of laser point cloud data at two adjacent moments, which will not be repeated here.
[0092] The present application also provides a computer storage medium in which program instructions are stored. When the program is executed, it may include: Figure 3 And part or all of the steps of the posture acquisition method in its corresponding embodiments.
[0093] Figure 5 A structural diagram of a posture acquisition system provided in an embodiment of the present application is shown in FIG. Figure 5 As shown, the posture acquisition system 500 of this embodiment may include: a first detection device 501, a second detection device 502 and a processor 503. The first detection device 501, the second detection device 502 and the processor 503 may be connected via a bus. Optionally, the posture acquisition system 500 may also include a third detection device 504, which may be connected to the above components via a bus.
[0094] The first detection device 501 is used to obtain laser point cloud data.
[0095] The second detection device 502 is used to obtain position information.
[0096] Processor 503 is used to obtain the laser point cloud data at each moment obtained by the first detection device and the posture information at each moment obtained by the second detection device during the movement of the movable platform in the target area; obtain the relative posture relationship between the laser point clouds at two adjacent moments based on the laser point cloud data at two adjacent moments; correct the posture of the laser point cloud at each moment based on the relative posture relationship between the laser point clouds at two adjacent moments and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment.
[0097] In some embodiments, the processor 503 is specifically configured to:
[0098] For any moment i, according to the posture information at each moment, determine the K moments whose posture is within a preset distance from the posture at moment i, where K, i is an integer greater than or equal to 1;
[0099] According to the laser point cloud data at the K moments and the laser point cloud data at the moment i, a relative position and posture relationship between the laser point cloud at the moment i and each of the K moments is obtained;
[0100] According to the relative posture relationship between the laser point cloud at each moment i and each of the K moments, and the relative posture relationship between the laser point clouds at two adjacent moments, the posture of the laser point cloud at each moment is corrected.
[0101] In some embodiments, the processor 503 is specifically configured to:
[0102] According to the relative pose relationship between the laser point cloud at time i and time j among K moments, and the relative pose relationship between the laser point clouds at each adjacent moment between time i and time j, the pose of the laser point cloud from time i to time j is corrected.
[0103] In some embodiments, the processor 503 is specifically configured to:
[0104] According to the relative pose relationship of the laser point clouds at each adjacent time from time i to time j, and the relative pose relationship of the laser point clouds at time i and time j, the relative pose relationship error of the laser point clouds at time i and time j is determined;
[0105] According to the relative posture relationship error, correct the relative posture relationship of the laser point cloud at each adjacent time from time i to time j;
[0106] According to the corrected relative position relationship of the laser point cloud at each adjacent time from time i to time j, the laser point cloud data from time i to time j is corrected.
[0107] In some embodiments, the processor 503 is specifically configured to:
[0108] According to the fact that the sum of the relative posture relationship errors corresponding to each moment i is minimized, the relative posture relationship of the laser point cloud at each adjacent moment is corrected.
[0109] In some embodiments, the corrected position and posture of the laser point cloud includes at least one of the following: altitude information and heading information.
[0110] In some embodiments, the processor 503 is specifically configured to:
[0111] According to the laser point cloud data at two adjacent moments, determining whether the laser point cloud data at two adjacent moments match;
[0112] If they match, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained based on the laser point cloud data at two adjacent moments.
[0113] In some embodiments, the processor 503 is specifically configured to:
[0114] According to the posture information at each moment, determine that the moment whose posture is within a preset distance from the posture at moment i is M moments, where M is an integer greater than or equal to K;
[0115] According to the laser point cloud data at time i and the laser point cloud data at the M time moments, K time moments at which the laser point cloud data in the M time moments respectively match the laser point cloud data at time i are determined.
[0116] In some embodiments, if the distance between the normal vectors of the laser point cloud data at two moments is less than a preset value, the laser point cloud data at the two moments match.
[0117] In some embodiments, the processor 503 is specifically configured to:
[0118] Obtain the estimated relative pose relationship of the laser point cloud at two moments;
[0119] The relative posture relationship of the laser point clouds at the two moments is obtained according to the estimated relative posture relationship and the laser point cloud data at the two moments.
[0120] In some embodiments, the third detection device 504 is used to obtain VINS posture data;
[0121] The processor 503 is specifically used to: obtain the VINS posture data obtained by the third detection device 504 at two moments; and obtain the estimated relative posture relationship of the laser point cloud at the two moments according to the VINS posture data at the two moments.
[0122] In some embodiments, the processor 503 is specifically configured to:
[0123] Estimate the laser point cloud data at the latter moment of the two moments according to the laser point cloud data at the former moment of the two moments and the estimated relative pose relationship;
[0124] The relative posture relationship of the laser point clouds at two moments is obtained based on the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship.
[0125] In some embodiments, the processor 503 is specifically configured to:
[0126] Determine the relative position and posture relationship deviation according to the estimated laser point cloud data at a later moment and the laser point cloud data at a later moment acquired by the first detection device;
[0127] The relative posture relationship of the laser point clouds at two moments is obtained according to the relative posture relationship deviation and the estimated relative posture relationship.
[0128] In some embodiments, the position information includes GPS data.
[0129] In some embodiments, the relative posture relationship includes at least one of the following: a rotation matrix and a displacement matrix.
[0130] In some embodiments, the processor 503 is further configured to create a map based on the target pose of the laser point cloud at each moment.
[0131] Optionally, the posture acquisition system 500 of this embodiment may also include: a memory (not shown in the figure) for storing program code, the memory is used to store program code, and when the program code is executed, the posture acquisition system 500 can implement the above-mentioned technical solution.
[0132] The posture acquisition system of this embodiment can be used to perform Figure 3 The technical solutions of the corresponding method embodiments have similar implementation principles and technical effects, which will not be repeated here.
[0133] Figure 6 A structural diagram of a posture acquisition system provided in another embodiment of the present application is shown in FIG. Figure 6 As shown, the posture acquisition system 600 of this embodiment may include: a memory 601 and a processor 602. The memory 601 and the processor 602 may be connected via a bus.
[0134] Memory 601, used for storing program codes;
[0135] The processor 602 is configured to execute, when the program code is called:
[0136] The laser point cloud data and the posture information at each moment obtained during the movement of the movable platform in the target area are obtained; the relative posture relationship between the laser point clouds at two adjacent moments is obtained according to the laser point cloud data at two adjacent moments; the posture of the laser point cloud at each moment is corrected according to the relative posture relationship between the laser point clouds at two adjacent moments and the posture information at each moment to obtain the target posture of the laser point cloud at each moment.
[0137] In some embodiments, the processor 602 is specifically configured to:
[0138] For any moment i, according to the posture information at each moment, determine the K moments whose posture is within a preset distance from the posture at moment i, where K, i is an integer greater than or equal to 1;
[0139] According to the laser point cloud data at the K moments and the laser point cloud data at the moment i, a relative position and posture relationship between the laser point cloud at the moment i and each of the K moments is obtained;
[0140] According to the relative posture relationship between the laser point cloud at each moment i and each of the K moments, and the relative posture relationship between the laser point clouds at two adjacent moments, the posture of the laser point cloud at each moment is corrected.
[0141] In some embodiments, the processor 602 is specifically configured to:
[0142] According to the relative pose relationship between the laser point cloud at time i and time j among K moments, and the relative pose relationship between the laser point clouds at each adjacent moment between time i and time j, the pose of the laser point cloud from time i to time j is corrected.
[0143] In some embodiments, the processor 602 is specifically configured to:
[0144] According to the relative pose relationship of the laser point clouds at each adjacent time from time i to time j, and the relative pose relationship of the laser point clouds at time i and time j, the relative pose relationship error of the laser point clouds at time i and time j is determined;
[0145] According to the relative posture relationship error, correct the relative posture relationship of the laser point cloud at each adjacent time from time i to time j;
[0146] According to the corrected relative position relationship of the laser point cloud at each adjacent time from time i to time j, the laser point cloud data from time i to time j is corrected.
[0147] In some embodiments, the processor 602 is specifically configured to:
[0148] According to the fact that the sum of the relative posture relationship errors corresponding to each moment i is minimized, the relative posture relationship of the laser point cloud at each adjacent moment is corrected.
[0149] In some embodiments, the corrected position and posture of the laser point cloud includes at least one of the following: altitude information and heading information.
[0150] In some embodiments, the processor 602 is specifically configured to:
[0151] According to the laser point cloud data at two adjacent moments, determining whether the laser point cloud data at two adjacent moments match;
[0152] If they match, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained based on the laser point cloud data at two adjacent moments.
[0153] In some embodiments, the processor 602 is specifically configured to:
[0154] According to the posture information at each moment, determine that the moment whose posture is within a preset distance from the posture at moment i is M moments, where M is an integer greater than or equal to K;
[0155] According to the laser point cloud data at time i and the laser point cloud data at the M time moments, K time moments at which the laser point cloud data in the M time moments respectively match the laser point cloud data at time i are determined.
[0156] In some embodiments, if the distance between the normal vectors of the laser point cloud data at two moments is less than a preset value, the laser point cloud data at the two moments match.
[0157] In some embodiments, the processor 602 is specifically configured to:
[0158] Obtain the estimated relative pose relationship of the laser point cloud at two moments;
[0159] The relative posture relationship of the laser point clouds at the two moments is obtained according to the estimated relative posture relationship and the laser point cloud data at the two moments.
[0160] In some embodiments, the processor 602 is specifically used to: obtain VINS posture data obtained by the third detection device at two moments; and obtain the estimated relative posture relationship of the laser point cloud at the two moments based on the VINS posture data at the two moments.
[0161] In some embodiments, the processor 602 is specifically configured to:
[0162] Estimate the laser point cloud data at the latter moment of the two moments according to the laser point cloud data at the former moment of the two moments and the estimated relative pose relationship;
[0163] The relative posture relationship of the laser point clouds at two moments is obtained based on the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship.
[0164] In some embodiments, the processor 602 is specifically configured to:
[0165] Determine the relative position and posture relationship deviation according to the estimated laser point cloud data at a later moment and the laser point cloud data at a later moment acquired by the first detection device;
[0166] The relative posture relationship of the laser point clouds at two moments is obtained according to the relative posture relationship deviation and the estimated relative posture relationship.
[0167] In some embodiments, the position information includes GPS data.
[0168] In some embodiments, the relative posture relationship includes at least one of the following: a rotation matrix and a displacement matrix.
[0169] In some embodiments, the processor 602 is further configured to create a map based on the target pose of the laser point cloud at each moment.
[0170] The posture acquisition system of this embodiment can be used to perform Figure 3 The technical solutions of the corresponding method embodiments have similar implementation principles and technical effects, which will not be repeated here.
[0171] Figure 7 A schematic diagram of the structure of a movable platform provided in an embodiment of the present application is shown in FIG. Figure 7 As shown, the movable platform 700 of this embodiment may include: a first detection device 701, a second detection device 702 and a processor 703. The first detection device 701, the second detection device 702 and the processor 703 may be connected via a bus. Optionally, the movable platform 700 may also include a third detection device 704, which may be connected to the above components via a bus.
[0172] The first detection device 701 is used to obtain laser point cloud data.
[0173] The second detection device 702 is used to obtain position information.
[0174] The processor 703 is used to obtain the laser point cloud data at each moment obtained by the first detection device 701 and the posture information at each moment obtained by the second detection device 702 during the movement of the movable platform 700 in the target area; obtain the relative posture relationship between the laser point clouds at two adjacent moments based on the laser point cloud data at two adjacent moments; correct the posture of the laser point cloud at each moment based on the relative posture relationship between the laser point clouds at two adjacent moments and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment.
[0175] In some embodiments, the processor 703 is specifically configured to:
[0176] For any moment i, according to the posture information at each moment, determine the K moments whose posture is within a preset distance from the posture at moment i, where K, i is an integer greater than or equal to 1;
[0177] According to the laser point cloud data at the K moments and the laser point cloud data at the moment i, a relative position and posture relationship between the laser point cloud at the moment i and each of the K moments is obtained;
[0178] According to the relative posture relationship between the laser point cloud at each moment i and each of the K moments, and the relative posture relationship between the laser point clouds at two adjacent moments, the posture of the laser point cloud at each moment is corrected.
[0179] In some embodiments, the processor 703 is specifically configured to:
[0180] According to the relative pose relationship between the laser point cloud at time i and time j among K moments, and the relative pose relationship between the laser point clouds at each adjacent moment between time i and time j, the pose of the laser point cloud from time i to time j is corrected.
[0181] In some embodiments, the processor 703 is specifically configured to:
[0182] According to the relative pose relationship of the laser point clouds at each adjacent time from time i to time j, and the relative pose relationship of the laser point clouds at time i and time j, the relative pose relationship error of the laser point clouds at time i and time j is determined;
[0183] According to the relative posture relationship error, correct the relative posture relationship of the laser point cloud at each adjacent time from time i to time j;
[0184] According to the corrected relative position relationship of the laser point cloud at each adjacent time from time i to time j, the laser point cloud data from time i to time j is corrected.
[0185] In some embodiments, the processor 703 is specifically configured to:
[0186] According to the fact that the sum of the relative posture relationship errors corresponding to each moment i is minimized, the relative posture relationship of the laser point cloud at each adjacent moment is corrected.
[0187] In some embodiments, the corrected position and posture of the laser point cloud includes at least one of the following: altitude information and heading information.
[0188] In some embodiments, the processor 703 is specifically configured to:
[0189] According to the laser point cloud data at two adjacent moments, determining whether the laser point cloud data at two adjacent moments match;
[0190] If they match, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained based on the laser point cloud data at two adjacent moments.
[0191] In some embodiments, the processor 703 is specifically configured to:
[0192] According to the posture information at each moment, determine that the moment whose posture is within a preset distance from the posture at moment i is M moments, where M is an integer greater than or equal to K;
[0193] According to the laser point cloud data at time i and the laser point cloud data at the M time moments, K time moments at which the laser point cloud data in the M time moments respectively match the laser point cloud data at time i are determined.
[0194] In some embodiments, if the distance between the normal vectors of the laser point cloud data at two moments is less than a preset value, the laser point cloud data at the two moments match.
[0195] In some embodiments, the processor 703 is specifically configured to:
[0196] Obtain the estimated relative pose relationship of the laser point cloud at two moments;
[0197] The relative posture relationship of the laser point clouds at the two moments is obtained according to the estimated relative posture relationship and the laser point cloud data at the two moments.
[0198] In some embodiments, the third detection device 704 is used to obtain VINS posture data;
[0199] The processor 703 is specifically used to: obtain the VINS posture data obtained by the third detection device 704 at two moments; and obtain the estimated relative posture relationship of the laser point cloud at the two moments according to the VINS posture data at the two moments.
[0200] In some embodiments, the processor 703 is specifically configured to:
[0201] Estimate the laser point cloud data at the latter moment of the two moments according to the laser point cloud data at the former moment of the two moments and the estimated relative pose relationship;
[0202] The relative posture relationship of the laser point clouds at two moments is obtained based on the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship.
[0203] In some embodiments, the processor 703 is specifically configured to:
[0204] Determine the relative position and posture relationship deviation according to the estimated laser point cloud data at a later moment and the laser point cloud data at a later moment acquired by the first detection device;
[0205] The relative posture relationship of the laser point clouds at two moments is obtained according to the relative posture relationship deviation and the estimated relative posture relationship.
[0206] In some embodiments, the position information includes GPS data.
[0207] In some embodiments, the relative posture relationship includes at least one of the following: a rotation matrix and a displacement matrix.
[0208] In some embodiments, the processor 703 is further configured to create a map based on the target pose of the laser point cloud at each moment.
[0209] Optionally, the movable platform 700 of this embodiment may further include: a memory (not shown in the figure) for storing program codes, the memory is used to store program codes, and when the program codes are executed, the movable platform 700 can implement the above technical solution.
[0210] The mobile platform of this embodiment can be used to perform Figure 3 The technical solutions of the corresponding method embodiments have similar implementation principles and technical effects, which will not be repeated here.
[0211] Figure 8 A schematic diagram of the structure of a movable platform provided in another embodiment of the present application is shown in FIG. Figure 8 As shown, the movable platform 800 of this embodiment may include: a movable platform body 801 and a position and posture acquisition system 802 .
[0212] The position acquisition system 802 is installed on the movable platform body 801. The position acquisition system 802 may be a device independent of the movable platform body 801.
[0213] Among them, the posture acquisition system 802 can use Figure 5 or Figure 6 The structure of the device embodiment shown in the figure can be executed accordingly. Figure 3 The technical solutions of the corresponding method embodiments have similar implementation principles and technical effects, which will not be repeated here.
[0214] Optionally, the movable platform 800 includes a handheld phone, a handheld gimbal, a drone, an unmanned vehicle, an unmanned ship, a robot or an autonomous vehicle.
[0215] Those skilled in the art can understand that all or part of the steps of implementing the above method embodiments can be completed by hardware related to program instructions, and the aforementioned program can be stored in a computer-readable storage medium. When the program is executed, it executes the steps of the above method embodiments; and the aforementioned storage medium includes: read-only memory (ROM), random access memory (RAM), magnetic disk or optical disk, etc. Various media that can store program codes.
[0216] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit it. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present application.
Claims
1. A posture acquisition method, characterized in that: Applied to a movable platform, the movable platform is provided with a first detection device for acquiring laser point cloud data, and a second detection device for acquiring position information; comprising: Acquire the laser point cloud data and the position and posture information at each moment acquired during the movement of the movable platform in the target area; wherein the position and posture information includes the position and posture information of the movable platform; According to the laser point cloud data at two adjacent moments, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained; For any moment i, according to the posture information at each moment, determine the K moments whose posture is within a preset distance from the posture at moment i, where K, i is an integer greater than or equal to 1; According to the laser point cloud data at the K moments and the laser point cloud data at the moment i, a relative position and posture relationship between the laser point cloud at the moment i and each of the K moments is obtained; According to the relative pose relationship between the laser point cloud at each moment i and each of the K moments and the relative pose relationship between the laser point clouds at two adjacent moments, the pose of the laser point cloud at each moment is corrected to obtain the target pose of the laser point cloud at each moment.
2. The method according to claim 1, characterized in that The method of correcting the pose of the laser point cloud at each moment according to the relative pose relationship between each moment i and the laser point cloud at each of the K moments and the relative pose relationship between the laser point clouds at two adjacent moments includes: According to the relative pose relationship between the laser point cloud at time i and time j among K moments, and the relative pose relationship between the laser point clouds at each adjacent moment between time i and time j, the pose of the laser point cloud from time i to time j is corrected.
3. The method according to claim 2, characterized in that The method of correcting the pose of the laser point cloud from time i to time j according to the relative pose relationship between time i and time j among the K time moments, and the relative pose relationship between the laser point clouds at each adjacent time between time i and time j, includes: According to the relative pose relationship of the laser point clouds at each adjacent time from time i to time j, and the relative pose relationship of the laser point clouds at time i and time j, the relative pose relationship error of the laser point clouds at time i and time j is determined; According to the relative posture relationship error, correct the relative posture relationship of the laser point cloud at each adjacent time from time i to time j; According to the corrected relative position relationship of the laser point cloud at each adjacent time from time i to time j, the laser point cloud data from time i to time j is corrected.
4. The method according to claim 3, characterized in that: The method of correcting the relative posture relationship of the laser point cloud at each adjacent time from time i to time j according to the relative posture relationship error includes: According to the fact that the sum of the relative posture relationship errors corresponding to each moment i is minimized, the relative posture relationship of the laser point cloud at each adjacent moment is corrected.
5. The method according to any one of claims 1 to 4, characterized in that: The corrected position and posture of the laser point cloud includes at least one of the following: altitude information and heading information.
6. The method according to any one of claims 1 to 4, characterized in that: The step of obtaining the relative position and posture relationship of the laser point clouds at two adjacent moments according to the laser point cloud data at two adjacent moments includes: According to the laser point cloud data at two adjacent moments, determining whether the laser point cloud data at two adjacent moments match; If they match, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained based on the laser point cloud data at two adjacent moments.
7. The method according to claim 1, characterized in that The step of determining K moments whose posture is within a preset distance from the posture at the moment i according to the posture information at each moment includes: According to the posture information at each moment, determine that the moment whose posture is within a preset distance from the posture at moment i is M moments, where M is an integer greater than or equal to K; According to the laser point cloud data at time i and the laser point cloud data at the M time moments, K time moments at which the laser point cloud data in the M time moments respectively match the laser point cloud data at time i are determined.
8. The method according to claim 7, characterized in that If the distance between the normal vectors of the laser point cloud data at two moments is less than a preset value, the laser point cloud data at the two moments match.
9. The method according to any one of claims 1-4, 7 and 8, characterized in that: According to the laser point cloud data at two times, the relative position relationship of the laser point cloud at two times is obtained, including: Obtain the estimated relative pose relationship of the laser point cloud at two moments; The relative posture relationship of the laser point clouds at the two moments is obtained according to the estimated relative posture relationship and the laser point cloud data at the two moments.
10. The method according to claim 9, characterized in that The step of obtaining the estimated relative pose relationship of the laser point clouds at two moments includes: Obtaining VINS posture data of the movable platform obtained at two moments; According to the VINS pose data at two moments, the estimated relative pose relationship of the laser point cloud at two moments is obtained.
11. The method according to claim 10, characterized in that The step of obtaining the relative pose relationship of the laser point clouds at two moments according to the estimated relative pose relationship and the laser point cloud data collected at the two moments comprises: Estimate the laser point cloud data at the latter moment of the two moments according to the laser point cloud data at the former moment of the two moments and the estimated relative pose relationship; The relative posture relationship of the laser point clouds at two moments is obtained based on the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship.
12. The method according to claim 11, characterized in that The method of obtaining the relative posture relationship of the laser point clouds at two moments according to the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship comprises: Determine the relative position and posture relationship deviation according to the estimated laser point cloud data at a later moment and the laser point cloud data at a later moment acquired by the first detection device; The relative posture relationship of the laser point clouds at two moments is obtained according to the relative posture relationship deviation and the estimated relative posture relationship.
13. The method according to any one of claims 1-4, 7, 8, 10, 11, and 12, characterized in that: The position information includes GPS data.
14. The method according to any one of claims 1-4, 7, 8, 10, 11, and 12, characterized in that: The relative posture relationship includes at least one of the following: a rotation matrix and a displacement matrix.
15. The method according to any one of claims 1-4, 7, 8, 10, 11, and 12, characterized in that: Also includes: A map is created based on the target pose of the laser point cloud at each moment.
16. A posture acquisition system, characterized in that: Applications on mobile platforms include: A first detection device, used to obtain laser point cloud data; A second detection device, used to obtain position information, wherein the position information includes the position information of the movable platform; A processor, used for acquiring the laser point cloud data at each moment acquired by the first detection device and the posture information at each moment acquired by the second detection device during the movement of the movable platform in the target area; obtaining the relative posture relationship between the laser point clouds at two adjacent moments according to the laser point cloud data at two adjacent moments; correcting the posture of the laser point cloud at each moment according to the relative posture relationship between the laser point clouds at two adjacent moments and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment; The processor is specifically used for: For any moment i, according to the posture information of each moment, determine the K moments whose posture is within a preset distance from the posture at moment i, where K, i is an integer greater than or equal to 1; According to the laser point cloud data at the K moments and the laser point cloud data at the moment i, the relative position and posture relationship between the laser point cloud at the moment i and each of the K moments is obtained; According to the relative posture relationship between the laser point cloud at each moment i and each of the K moments, and the relative posture relationship between the laser point clouds at two adjacent moments, the posture of the laser point cloud at each moment is corrected.
17. The system according to claim 16, characterized in that The processor is specifically used to correct the pose of the laser point cloud from time i to time j according to the relative pose relationship between the laser point cloud at time i and time j among K time moments, and the relative pose relationship between the laser point clouds at each adjacent time between time i and time j.
18. The system according to claim 17, characterized in that The processor is specifically used to: determine the relative posture relationship error of the laser point cloud at time i and time j according to the relative posture relationship of the laser point cloud at each adjacent time from time i to time j, and the relative posture relationship of the laser point cloud at time i and time j; According to the relative posture relationship error, correct the relative posture relationship of the laser point cloud at each adjacent time from time i to time j; According to the corrected relative position relationship of the laser point cloud at each adjacent time from time i to time j, the laser point cloud data from time i to time j is corrected.
19. The system according to claim 18, characterized in that The processor is specifically used to: correct the relative posture of the laser point cloud at each adjacent moment according to the minimum sum of the relative posture relationship errors corresponding to each moment i relation.
20. The system according to any one of claims 16 to 19, characterized in that: The corrected position and posture of the laser point cloud includes at least one of the following: altitude information and heading information.
21. The system according to any one of claims 16 to 19, characterized in that: The processor is specifically used for: According to the laser point cloud data at two adjacent moments, determining whether the laser point cloud data at two adjacent moments match; If they match, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained based on the laser point cloud data at two adjacent moments.
22. The system according to claim 16, characterized in that The processor is specifically used for: According to the posture information at each moment, determine that the moment whose posture is within a preset distance from the posture at moment i is M moments, where M is an integer greater than or equal to K; According to the laser point cloud data at time i and the laser point cloud data at the M time moments, K time moments at which the laser point cloud data in the M time moments respectively match the laser point cloud data at time i are determined.
23. The system according to claim 22, characterized in that If the distance between the normal vectors of the laser point cloud data at two moments is less than a preset value, the laser point cloud data at the two moments match.
24. The system according to any one of claims 16-19, 22 and 23, characterized in that: The processor is specifically used for: Obtain the estimated relative pose relationship of the laser point cloud at two moments; The relative posture relationship of the laser point clouds at the two moments is obtained according to the estimated relative posture relationship and the laser point cloud data at the two moments.
25. The system according to claim 24, characterized in that Also included is a third detection device; The third detection device is used to obtain VINS posture data; The processor is specifically used to: obtain the VINS posture data obtained by the third detection device at two moments; and obtain the estimated relative posture relationship of the laser point cloud at the two moments based on the VINS posture data at the two moments.
26. The system according to claim 25, characterized in that The processor is specifically used for: Estimate the laser point cloud data at the latter moment of the two moments according to the laser point cloud data at the former moment of the two moments and the estimated relative pose relationship; The relative posture relationship of the laser point clouds at two moments is obtained based on the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship.
27. The system according to claim 26, characterized in that The processor is specifically used for: Determine the relative position and posture relationship deviation according to the estimated laser point cloud data at a later moment and the laser point cloud data at a later moment acquired by the first detection device; The relative posture relationship of the laser point clouds at two moments is obtained according to the relative posture relationship deviation and the estimated relative posture relationship.
28. The system according to any one of claims 16-19, 22, 23, 25, 26, 27, characterized in that: The position information includes GPS data.
29. The system according to any one of claims 16-19, 22, 23, 25, 26, and 27, characterized in that: The relative posture relationship includes at least one of the following: a rotation matrix and a displacement matrix.
30. The system according to any one of claims 16-19, 22, 23, 25, 26, 27, characterized in that: The processor is further used to establish a map according to the target posture of the laser point cloud at each moment.
31. A movable platform, characterized in that: include: A first detection device, used to obtain laser point cloud data; A second detection device, used to obtain position information, wherein the position information includes the position information of the movable platform; A processor, used for acquiring the laser point cloud data at each moment acquired by the first detection device and the posture information at each moment acquired by the second detection device during the movement of the movable platform in the target area; obtaining the relative posture relationship between the laser point clouds at two adjacent moments according to the laser point cloud data at two adjacent moments; correcting the posture of the laser point cloud at each moment according to the relative posture relationship between the laser point clouds at two adjacent moments and the posture information at each moment, so as to obtain the target posture of the laser point cloud at each moment; It is characterized in that the processor is specifically used for: For any moment i, according to the posture information at each moment, determine the K moments whose posture is within a preset distance from the posture at moment i, where K, i is an integer greater than or equal to 1; According to the laser point cloud data at the K moments and the laser point cloud data at the moment i, a relative position and posture relationship between the laser point cloud at the moment i and each of the K moments is obtained; According to the relative posture relationship between the laser point cloud at each moment i and each of the K moments, and the relative posture relationship between the laser point clouds at two adjacent moments, the posture of the laser point cloud at each moment is corrected.
32. The movable platform according to claim 31, characterized in that: The processor is specifically used for: According to the relative pose relationship between the laser point cloud at time i and time j among K moments, and the relative pose relationship between the laser point clouds at each adjacent moment between time i and time j, the pose of the laser point cloud from time i to time j is corrected.
33. The movable platform according to claim 32, characterized in that: The processor is specifically used to: determine the relative posture relationship error of the laser point cloud at time i and time j according to the relative posture relationship of the laser point cloud at each adjacent time from time i to time j, and the relative posture relationship of the laser point cloud at time i and time j; According to the relative posture relationship error, correct the relative posture relationship of the laser point cloud at each adjacent time from time i to time j; According to the corrected relative position relationship of the laser point cloud at each adjacent time from time i to time j, the laser point cloud data from time i to time j is corrected.
34. The movable platform according to claim 33, characterized in that: The processor is specifically used for: According to the fact that the sum of the relative posture relationship errors corresponding to each moment i is minimized, the relative posture relationship of the laser point cloud at each adjacent moment is corrected.
35. The movable platform according to any one of claims 31 to 34, characterized in that: The corrected position and posture of the laser point cloud includes at least one of the following: altitude information and heading information.
36. The movable platform according to any one of claims 31 to 34, characterized in that: The processor is specifically used for: According to the laser point cloud data at two adjacent moments, determining whether the laser point cloud data at two adjacent moments match; If they match, the relative position and posture relationship of the laser point clouds at two adjacent moments is obtained based on the laser point cloud data at two adjacent moments.
37. The movable platform according to claim 36, characterized in that: The processor is specifically used for: According to the posture information at each moment, determine that the moment whose posture is within a preset distance from the posture at moment i is M moments, where M is an integer greater than or equal to K; According to the laser point cloud data at time i and the laser point cloud data at the M time moments, K time moments at which the laser point cloud data in the M time moments respectively match the laser point cloud data at time i are determined.
38. The movable platform according to claim 37, characterized in that: If the distance between the normal vectors of the laser point cloud data at two moments is less than a preset value, the laser point cloud data at the two moments match.
39. The movable platform according to any one of claims 31-34, 37, and 38, characterized in that: The processor is specifically used for: Obtain the estimated relative pose relationship of the laser point cloud at two moments; The relative posture relationship of the laser point clouds at the two moments is obtained according to the estimated relative posture relationship and the laser point cloud data at the two moments.
40. The movable platform according to claim 39, characterized in that: Also included is a third detection device; The third detection device is used to obtain VINS posture data; The processor is specifically used to: obtain the VINS posture data obtained by the third detection device at two moments; and obtain the estimated relative posture relationship of the laser point cloud at the two moments based on the VINS posture data at the two moments.
41. The movable platform according to claim 40, characterized in that The processor is specifically used for: Estimate the laser point cloud data at the latter moment of the two moments according to the laser point cloud data at the former moment of the two moments and the estimated relative pose relationship; The relative posture relationship of the laser point clouds at two moments is obtained based on the estimated laser point cloud data at a later moment, the laser point cloud data at a later moment acquired by the first detection device, and the estimated relative posture relationship.
42. The movable platform according to claim 41, characterized in that The processor is specifically used for: Determine the relative position and posture relationship deviation according to the estimated laser point cloud data at a later moment and the laser point cloud data at a later moment acquired by the first detection device; The relative posture relationship of the laser point clouds at two moments is obtained according to the relative posture relationship deviation and the estimated relative posture relationship.
43. The movable platform according to any one of claims 31-34, 37, 38, 40, 41, 42, characterized in that: The position information includes GPS data.
44. The movable platform according to any one of claims 31-34, 37, 38, 40, 41, 42, characterized in that: The relative posture relationship includes at least one of the following: a rotation matrix and a displacement matrix.
45. The movable platform according to any one of claims 31-34, 37, 38, 40, 41, 42, characterized in that: The processor is further used to establish a map according to the target posture of the laser point cloud at each moment.
46. The movable platform according to any one of claims 31-34, 37, 38, 40, 41, 42, characterized in that: The movable platform includes an autonomous vehicle.
47. A readable storage medium, characterized in that The readable storage medium stores a computer program; when the computer program is executed, it implements the posture acquisition method as described in any one of claims 1-15.
48. A computer program product comprising a computer program, characterized in that When the computer program is executed by a processor, the posture acquisition method as described in any one of claims 1 to 15 is implemented.
