CN115200608A - Method for calibrating installation error of water laser radar and inertial navigation - Google Patents

Method for calibrating installation error of water laser radar and inertial navigation Download PDF

Info

Publication number
CN115200608A
CN115200608A CN202210658082.3A CN202210658082A CN115200608A CN 115200608 A CN115200608 A CN 115200608A CN 202210658082 A CN202210658082 A CN 202210658082A CN 115200608 A CN115200608 A CN 115200608A
Authority
CN
China
Prior art keywords
laser radar
inertial navigation
coordinate system
installation error
imu
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
CN202210658082.3A
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.)
Beijign Institute of Aerospace Control Devices
Original Assignee
Beijign Institute of Aerospace Control Devices
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 Beijign Institute of Aerospace Control Devices filed Critical Beijign Institute of Aerospace Control Devices
Priority to CN202210658082.3A priority Critical patent/CN115200608A/en
Publication of CN115200608A publication Critical patent/CN115200608A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
    • 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/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • G01C21/1652Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with ranging devices, e.g. LIDAR or RADAR
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/86Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497Means for monitoring or calibrating

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Manufacturing & Machinery (AREA)
  • Automation & Control Theory (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

The invention discloses a method for calibrating installation errors of a water laser radar and an inertial navigation system, which comprises the following steps: (1) Collecting laser radar point cloud data of a relative static target A and position posture data of inertial navigation equipment at N different collecting positions; respectively recording the laser radar point cloud data of the relative static target A acquired at the kth acquisition position and the position and attitude data of the inertial navigation equipment as C k And I k (ii) a (2) According to C k And I k Obtaining the position coordinates of the relative static target A in the laser radar coordinate system
Figure DDA0003689194920000011
And the position coordinates of the k-th acquisition position in the navigation coordinate system
Figure DDA0003689194920000012
(3) According to
Figure DDA0003689194920000013
And
Figure DDA0003689194920000014
and obtaining the installation error E of the laser radar and the inertial navigation equipment based on a global search algorithm. According to the invention, by sampling a simple scene and applying a search algorithm and a statistical method, the calibration of the installation error of the laser radar and the inertial navigation is realized, the adaptability of the calibration scene to the environment is improved, and the calibration difficulty is reduced.

Description

Method for calibrating installation errors of water laser radar and inertial navigation
Technical Field
The invention relates to a method for calibrating installation errors of a water laser radar and inertial navigation, and belongs to the field of unmanned ship intelligence and ocean intelligence equipment.
Background
At present, unmanned intelligent equipment is developed vigorously, and the development thereof cannot be separated from the capacity improvement of detection equipment. However, for the improvement of the accuracy of the detection position, besides the adoption of the laser radar with the measurement accuracy superior to 1 cm, the calibration method of the laser radar and the inertial navigation equipment also has an important role. The existing laser radar and inertial navigation installation error calibration is a mature technology in the field of unmanned vehicles, and a vehicle-mounted computer collects data of a surrounding static environment by controlling the vehicle to move according to a specific track. The method for calibrating the personnel point cloud data matching is used for calibration, and the method not only needs a large amount of calculation power of a computer, but also can not be suitable for the condition that the number of absolute still targets on water is small because the absolute still targets are basically all in the environment.
Disclosure of Invention
The invention aims to overcome the defects and provides a water laser radar and inertial navigation installation errorThe calibration method comprises the following steps: (1) Collecting laser radar point cloud data of a relative static target A and position posture data of inertial navigation equipment at N different collecting positions; respectively recording laser radar point cloud data of a relative static target A acquired at the kth acquisition position and position attitude data of inertial navigation equipment as C k And I k
Figure BDA0003689194900000011
Figure BDA0003689194900000012
Represents an integer; (2) Laser radar point cloud data C of relative static target A acquired according to kth acquisition position k And position attitude data I of inertial navigation device k Obtaining the position coordinates of the relative static target A in the laser radar coordinate system
Figure BDA0003689194900000013
And the position coordinates of the k-th acquisition position in the navigation coordinate system
Figure BDA0003689194900000014
Wherein lidar represents a laser radar coordinate system, and navi represents a navigation coordinate system; (3) Obtained according to the step (2)
Figure BDA0003689194900000015
And
Figure BDA0003689194900000016
and obtaining the installation error E of the laser radar and the inertial navigation equipment based on a global search algorithm. The method realizes the calibration of the installation error of the laser radar and the inertial navigation by sampling a simple scene and applying a search algorithm and a statistical method, improves the adaptability of the calibration scene to the environment and reduces the calibration difficulty.
In order to achieve the above purpose, the invention provides the following technical scheme:
a method for calibrating installation errors of a water laser radar and an inertial navigation system comprises the following steps:
(1) Collecting laser radar point cloud data of a relative static target A and position posture data of inertial navigation equipment at N different collecting positions; respectively recording laser radar point cloud data of a relative static target A acquired at the kth acquisition position and position attitude data of inertial navigation equipment as C k And I k
Figure BDA0003689194900000021
Figure BDA0003689194900000022
Represents an integer;
(2) Collecting laser radar point cloud data C of relative static target A according to kth collecting position k And position attitude data I of inertial navigation device k Obtaining the position coordinates of the relative static target A in the laser radar coordinate system
Figure BDA0003689194900000023
And the position coordinates of the k-th acquisition position in the navigation coordinate system
Figure BDA0003689194900000024
Wherein lidar represents a laser radar coordinate system, and navi represents a navigation coordinate system;
(3) Obtained according to the step (2)
Figure BDA0003689194900000025
And
Figure BDA0003689194900000026
and obtaining the installation error E of the laser radar and the inertial navigation equipment based on a global search algorithm.
Further, in the step (1), the laser radar point cloud data of the relative static target A
Figure BDA0003689194900000027
Wherein
Figure BDA0003689194900000028
The coordinate value of each component of the ith point of the laser radar point cloud relative to the static target A in a laser radar coordinate system at the kth acquisition position, M k The point cloud total number of the laser radar at the kth acquisition position;
position and attitude data I of inertial navigation equipment k =(lat k ,lng kkkk ) Wherein, lat k 、lng k 、θ k 、ψ k 、φ k Respectively the latitude, longitude, pitch angle, course angle and roll angle of the kth acquisition position.
Further, in the step (1), the total number N of the acquisition positions is not less than 20, and the relative static object a is located in an area surrounded by the 1 st to N-th acquisition positions.
Further, the specific method of the step (2) is as follows:
(2.1) using the longitude and the latitude of the 1 st acquisition position as the origin of a navigation coordinate system;
(2.2) let k =1;
(2.3) laser radar point cloud data C according to relative static target A k Obtaining the position coordinates of the relative static target A under the laser radar coordinate system
Figure BDA0003689194900000029
(2.4) according to the latitude lat at the 1 st acquisition position 1 And longitude lng 1 And the latitude lat of the kth acquisition location k And longitude lng k Obtaining the position coordinates of the kth acquisition position in a navigation coordinate system
Figure BDA0003689194900000031
(2.7) if k = N, ending the calculation, otherwise let k = k +1, and returning to step (2.3).
Further, in the step (2.3),
Figure BDA0003689194900000032
the calculation formula of (c) is as follows:
Figure BDA0003689194900000033
further, in the step (2.4),
Figure BDA0003689194900000034
the calculation formula of (a) is as follows:
Figure BDA0003689194900000035
wherein R is M And R N Respectively, the latitude is lat 1 The meridian plane curvature radius of the earth and the prime plane curvature radius of the prime plane.
Further, in the step (3), an installation error E between the laser radar and the inertial navigation device is as follows:
E=(Δθ,Δψ,Δφ,Δx imu ,Δy imu ,Δz imu )
wherein, the delta theta, the delta psi and the delta phi respectively represent a pitch angle installation error, a course angle installation error and a roll angle installation error of the laser radar and the inertial navigation equipment, and the delta x imu 、Δy imu 、Δz imu And the position installation error of each component of the laser radar and the inertial navigation equipment in the inertial navigation equipment coordinate system is shown, and the imu shows the inertial navigation equipment coordinate system.
Further, in the step (3), the product obtained according to the step (2)
Figure BDA0003689194900000036
And
Figure BDA0003689194900000037
based on a global search algorithm, finding a point which minimizes the J value, namely the mounting error E of the laser radar and the inertial navigation equipment:
Figure BDA0003689194900000038
wherein the content of the first and second substances,
Figure BDA0003689194900000039
Figure BDA00036891949000000310
representing a conversion matrix of the laser radar coordinate system to the inertial navigation equipment coordinate system attitude,
Figure BDA00036891949000000311
representing the transformation matrix, theta, from the inertial navigation device coordinate system to the navigation coordinate system attitude k 、ψ k 、φ k The pitch angle, the course angle and the roll angle of the kth acquisition position are respectively,
Figure BDA0003689194900000041
cov represents a covariance matrix, det represents a determinant of the matrix, and S (E) is θ, Δ ψ, Δ φ, Δ x imu 、Δy imu 、Δz imu The value space of (2).
Further, the maximum value of S (E) is:
Figure BDA0003689194900000042
Δψ∈[-0,2π)、Δφ∈[-π,π)
Figure BDA0003689194900000043
wherein
Figure BDA0003689194900000044
Representing the entire real space.
Further, S (E) is:
Figure BDA0003689194900000045
wherein the content of the first and second substances,
Figure BDA0003689194900000046
the range of the mounting error of the maximum pitch angle, the range of the mounting error of the course angle and the range of the mounting error of the roll angle which are estimated according to the angle deviation of the actual mounting positions of the laser radar and the inertial navigation are respectively; for example, in a typical installation, the lidar and inertial navigation systems are each substantially identical in coordinate system, i.e., the directions in which the respective components are directed in the two coordinate systems substantially coincide (i.e., less than 10 °), which may be desirable
Figure BDA0003689194900000047
Figure BDA0003689194900000048
Respectively estimating the maximum position installation error ranges of the laser radar and the inertial navigation equipment on each component in an inertial navigation equipment coordinate system according to the angle deviation of the actual installation positions of the laser radar and the inertial navigation; for example, in the navigation coordinate system, the laser radar is installed approximately at the position
Figure BDA0003689194900000049
At the coordinate point, the measurement error is (e) x ,e y ,e z ) Then:
Figure BDA00036891949000000410
Figure BDA00036891949000000411
Figure BDA00036891949000000412
compared with the prior art, the invention has the following beneficial effects:
(1) The invention relates to a method for calibrating installation errors of a water laser radar and an inertial navigation, which realizes the calibration of the installation errors of the laser radar and the inertial navigation by sampling a simple scene and applying a search algorithm and a statistical method;
(2) The invention can calibrate only by collecting a certain relative static obstacle (such as a buoy) on water, thereby greatly reducing the requirement of a calibration site and improving the adaptability of a calibration scene to the environment;
(3) The invention meets the requirement of computing power brought by a large number of points, reduces the calibration difficulty while ensuring the calibration precision, and has practical application value.
Drawings
FIG. 1 is a flow chart of a method for calibrating installation errors of a water laser radar and an inertial navigation system.
Detailed Description
The features and advantages of the present invention will become more apparent and apparent from the following detailed description of the invention.
The word "exemplary" is used exclusively herein to mean "serving as an example, embodiment, or illustration. Any embodiment described herein as "exemplary" is not necessarily to be construed as preferred or advantageous over other embodiments. While the various aspects of the embodiments are presented in drawings, the drawings are not necessarily drawn to scale unless specifically indicated.
The invention provides a method for calibrating installation errors of a water laser radar and an inertial navigation system, which can calculate by using an existing small-sized relative static target on water as a reference object. Firstly, collecting data of laser radars and inertial navigation equipment at different positions around the static target; then, calculating the detection results of different positions on the static target position; and finally, calculating the installation error between the two devices by a region search method according to detection results obtained at different positions. The method has the advantages of simple operation, low requirement on the field and simple data processing method.
As shown in fig. 1, the invention provides a method for calibrating installation errors of a water laser radar and an inertial navigation system, which comprises the following specific steps:
(1) In N different acquisition positions, acquiring laser radar point cloud data on a ship and position attitude data of inertial navigation equipment for a relatively static target A, and combining the point cloud data and the position attitude data into a number set D:
Figure BDA0003689194900000051
wherein the point cloud data of the laser radar at the k-th acquisition position is C k The position and attitude data of the inertial navigation equipment is I k
Figure BDA0003689194900000052
N represents the total number of acquisition positions,
Figure BDA0003689194900000053
represents an integer;
Figure BDA0003689194900000061
wherein
Figure BDA0003689194900000062
For the kth acquisition position, the coordinate values of x, y and z components of the ith point of the laser radar point cloud relative to the static target A in a laser radar coordinate system are represented by lidar, M is the laser radar coordinate system k The point cloud number of the laser radar at the kth acquisition position is calculated;
position and attitude data I of inertial navigation equipment k =(lat k ,lng kkkk ) Wherein, lat k 、lng k 、θ k 、ψ k 、φ k Respectively the latitude, longitude, pitch angle, course angle and roll angle of the k-th collection position, and actually the latitude, longitude, pitch angle, course angle and roll angle of the unmanned boat/ship.
The more acquisition positions the better, but not less than 20, and the area that each acquisition position encloses in sequence should contain the target a.
(2) Lidar point cloud data C from relatively static target A k And position and attitude data I of inertial navigation device k Obtaining the position of a relative static target A in a laser radar coordinate system
Figure BDA0003689194900000063
And acquiring the position of the location in the navigation coordinate system
Figure BDA0003689194900000064
Where navi represents the navigational coordinate system:
(a) Let lat 1 And lng 1 Is the origin in the navigation coordinate system, the origin coordinate is
Figure BDA0003689194900000065
Figure BDA0003689194900000066
(b) Initializing a parameter k to be 1, and calculating the curvature radius R of the meridian plane of the earth M Radius of curvature R of prime and prime plane N
Figure BDA0003689194900000067
Figure BDA0003689194900000068
Wherein R is e Radius of the major axis of the earth, f is the ovality of the earth (R in WGS84 model) e =6356752,f=1/298.257)。
(c) Calculating the position of A in the laser radar coordinate system under the k acquisition position
Figure BDA0003689194900000069
Figure BDA00036891949000000610
(d) Calculating the coordinates of the kth acquisition position in the navigation coordinate system
Figure BDA00036891949000000611
The calculation method is as follows.
Figure BDA0003689194900000071
(e) If k is equal to N, ending, otherwise k is equal to k +1, and returning to step (c).
(3) According to step (2)
Figure BDA0003689194900000072
And
Figure BDA0003689194900000073
and obtaining the installation error E of the laser radar and the inertial navigation equipment based on a global search algorithm. Wherein the installation error E is defined as follows:
E=(Δθ,Δψ,Δφ,Δx imu ,Δy imu ,Δz imu )
wherein, delta theta, delta psi and delta phi respectively represent installation errors of a pitch angle, a course angle and a roll angle, and delta x imu 、Δy imu 、Δz imu Respectively representing the installation errors of the components under the coordinate system of the inertial navigation equipment (namely the coordinate system of the inertial navigation equipment).
By global search algorithms (e.g., bee colony, genetic algorithm, annealing algorithm, etc.), at Δ θ, Δ ψ, Δ φ, Δ x imu 、Δy imu 、Δz imu And in a possible value space S (E), a point which enables the J value to be minimum is searched, namely the installation error E of the laser radar and the inertial navigation equipment.
Figure BDA0003689194900000074
Where cov denotes the covariance matrix, det denotes the determinant of the matrix,
Figure BDA0003689194900000075
is defined as follows.
Figure BDA0003689194900000076
Wherein
Figure BDA0003689194900000077
Is a posture conversion matrix from a laser radar coordinate system to an inertial navigation equipment coordinate system,
Figure BDA0003689194900000078
is a posture conversion matrix from the inertial navigation equipment coordinate system to the navigation coordinate system.
Figure BDA0003689194900000079
Figure BDA00036891949000000710
Δ v is defined as follows.
Figure BDA00036891949000000711
S (E) is delta theta, delta psi, delta phi and delta x imu 、Δy imu 、Δz imu The maximum value of S (E) is
Figure BDA0003689194900000081
Δψ∈[-0,2π)、Δφ∈[-π,π)
Figure BDA0003689194900000082
Wherein
Figure BDA0003689194900000083
Representing the entire real space.
In order to accelerate the global search, S (E) can estimate the maximum error angle and the error distance of the actual installation in advance for setting, and the value space of S (E) is
Figure BDA0003689194900000084
Figure BDA0003689194900000085
Respectively the estimated maximum pitch angle installation error range, course angle installation error range and roll angle installation error range,
Figure BDA0003689194900000086
the estimated maximum installation error ranges in the x direction, the y direction and the z direction of the inertial navigation equipment coordinate system are respectively.
The method can calibrate only by acquiring a certain relative static obstacle (such as a buoy) on the water, thereby improving the adaptability of a calibration scene to the environment. And the target position of the point cloud data of each acquisition point is extracted, and finally, calibration parameters are calculated by a mature global search algorithm and a statistical method. Compared with the prior art, the method has the advantages that the calculation complexity of the calibration algorithm is reduced, the requirement on the calculation force is reduced, and the method has practical application value.
The invention has been described in detail with reference to specific embodiments and illustrative examples, but the description is not intended to be construed in a limiting sense. Those skilled in the art will appreciate that various equivalent substitutions, modifications or improvements may be made to the technical solution of the present invention and its embodiments without departing from the spirit and scope of the present invention, which fall within the scope of the present invention. The scope of the invention is defined by the appended claims.
Those skilled in the art will appreciate that those matters not described in detail in the present specification are not particularly limited to the specific examples described herein.

Claims (10)

1. A method for calibrating installation errors of a water laser radar and an inertial navigation system is characterized by comprising the following steps:
collecting laser radar point cloud data of a relative static target A and position posture data of inertial navigation equipment at N different collecting positions; respectively recording laser radar point cloud data of a relative static target A acquired at the kth acquisition position and position attitude data of inertial navigation equipment as C k And I k
Figure FDA0003689194890000011
Figure FDA0003689194890000012
Figure FDA0003689194890000013
Represents an integer;
collecting the laser radar point cloud data C of the relative static target A according to the k acquisition position k And position attitude data I of inertial navigation device k Obtaining the position coordinates of the relative static target A in the laser radar coordinate system
Figure FDA0003689194890000014
And the position coordinates of the k-th acquisition position in the navigation coordinate system
Figure FDA0003689194890000015
Wherein lidar represents a laser radar coordinate system, and navi represents a navigation coordinate system;
according to
Figure FDA0003689194890000016
And
Figure FDA0003689194890000017
obtaining the laser radar and the inertial guidance based on the global search algorithmInstallation error E of the navigation equipment.
2. The method for calibration of installation error of lidar and inertial navigation system of claim 1, wherein the lidar point cloud data is relative to a static target a
Figure FDA0003689194890000018
Wherein
Figure FDA0003689194890000019
The coordinate value M of each component of the ith point of the laser radar point cloud relative to the static target A in the laser radar coordinate system at the kth acquisition position k The point cloud total number of the laser radar at the kth acquisition position;
position and attitude data I of inertial navigation equipment k =(lat k ,lng kkkk ) Wherein, lat k 、lng k 、θ k 、ψ k 、φ k Respectively the latitude, longitude, pitch angle, course angle and roll angle of the kth acquisition position.
3. The method for calibrating the installation error of the water laser radar and the inertial navigation system according to claim 1 or 2, wherein the total number N of the acquisition positions is not less than 20, and the relative static target A is located in an area surrounded by the 1 st to the N th acquisition positions.
4. The method for calibration of installation error of lidar and inertial navigation system according to claim 2, wherein the position coordinates of the relative static target a in the lidar coordinate system are obtained
Figure FDA00036891948900000110
And the position coordinates of the k-th acquisition position in the navigation coordinate system
Figure FDA00036891948900000111
The specific method comprises the following steps:
lidar point cloud data C from a relatively static target A k Obtaining the position coordinates of the relative static target A under a laser radar coordinate system
Figure FDA0003689194890000021
Taking the longitude and latitude of the 1 st acquisition position as the origin of a navigation coordinate system; according to the latitude lat at the 1 st acquisition position 1 And longitude lng 1 And the latitude lat of the kth acquisition location k And longitude lng k Obtaining the position coordinates of the k acquisition position in the navigation coordinate system
Figure FDA0003689194890000022
5. The method for calibrating installation errors of the water laser radar and the inertial navigation system according to claim 4,
Figure FDA0003689194890000023
the calculation formula of (a) is as follows:
Figure FDA0003689194890000024
6. the method for calibrating installation errors of the water laser radar and the inertial navigation system according to claim 4,
Figure FDA0003689194890000025
the calculation formula of (a) is as follows:
Figure FDA0003689194890000026
wherein R is M And R N Respectively has a latitude of lat 1 The meridian plane curvature radius of the earth and the prime plane curvature radius of the prime plane.
7. The method for calibrating the installation error of the water laser radar and the inertial navigation device according to claim 1, wherein the installation error E of the laser radar and the inertial navigation device is as follows:
E=(Δθ,Δψ,Δφ,Δx imu ,Δy imu ,Δz imu )
wherein, the delta theta, the delta psi and the delta phi respectively represent a pitch angle installation error, a course angle installation error and a roll angle installation error of the laser radar and the inertial navigation equipment, and the delta x imu 、Δy imu 、Δz imu And the position installation error of each component of the laser radar and the inertial navigation equipment in the inertial navigation equipment coordinate system is shown, and the imu shows the inertial navigation equipment coordinate system.
8. The method for calibration of installation error of lidar and inertial navigation system of claim 7, wherein the calibration is based on
Figure FDA0003689194890000027
And
Figure FDA0003689194890000028
based on a global search algorithm, finding a point which minimizes the J value, namely the mounting error E of the laser radar and the inertial navigation equipment:
Figure FDA0003689194890000031
wherein, the first and the second end of the pipe are connected with each other,
Figure FDA0003689194890000032
Figure FDA0003689194890000033
representing a transformation matrix from the laser radar coordinate system to the inertial navigation equipment coordinate system,
Figure FDA0003689194890000034
representing the transformation matrix, theta, from the inertial navigation device coordinate system to the navigation coordinate system attitude k 、ψ k 、φ k The pitch angle, the course angle and the roll angle of the kth acquisition position are respectively,
Figure FDA0003689194890000035
cov represents a covariance matrix, det represents a determinant of the matrix, and S (E) is θ, Δ ψ, Δ φ, Δ x imu 、Δy imu 、Δz imu The value space of (2).
9. The method for calibration of installation errors of lidar and inertial navigation system according to claim 8, wherein the maximum value of S (E) is:
Figure FDA0003689194890000036
Figure FDA0003689194890000037
wherein
Figure FDA00036891948900000311
Representing the entire real space.
10. The method for calibration of installation errors of lidar and inertial navigation system of claim 9, wherein S (E) is:
Figure FDA0003689194890000038
wherein the content of the first and second substances,
Figure FDA0003689194890000039
the maximum pitch angle installation error range, the course angle installation error range and the roll angle installation error range are respectively estimated according to the angle deviation of the actual installation positions of the laser radar and the inertial navigation;
Figure FDA00036891948900000310
the maximum position installation error ranges of the laser radar and the inertial navigation equipment on each component under the inertial navigation equipment coordinate system are estimated according to the angle deviation of the actual installation positions of the laser radar and the inertial navigation.
CN202210658082.3A 2022-06-10 2022-06-10 Method for calibrating installation error of water laser radar and inertial navigation Pending CN115200608A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210658082.3A CN115200608A (en) 2022-06-10 2022-06-10 Method for calibrating installation error of water laser radar and inertial navigation

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210658082.3A CN115200608A (en) 2022-06-10 2022-06-10 Method for calibrating installation error of water laser radar and inertial navigation

Publications (1)

Publication Number Publication Date
CN115200608A true CN115200608A (en) 2022-10-18

Family

ID=83577008

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210658082.3A Pending CN115200608A (en) 2022-06-10 2022-06-10 Method for calibrating installation error of water laser radar and inertial navigation

Country Status (1)

Country Link
CN (1) CN115200608A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115683170A (en) * 2023-01-04 2023-02-03 成都西物信安智能系统有限公司 Calibration method based on radar point cloud data fusion error

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105548976A (en) * 2015-12-14 2016-05-04 中国科学院长春光学精密机械与物理研究所 Shipborne radar offshore precision identification method
KR101888171B1 (en) * 2017-11-16 2018-08-13 엘아이지넥스원 주식회사 Method and device for recognizing environment based on position information of unmanned surface vessel
CN111239766A (en) * 2019-12-27 2020-06-05 北京航天控制仪器研究所 Water surface multi-target rapid identification and tracking method based on laser radar
CN111521996A (en) * 2020-05-30 2020-08-11 上海工程技术大学 Laser radar installation calibration method
CN113721260A (en) * 2021-08-26 2021-11-30 南京邮电大学 Online combined calibration method for laser radar, binocular camera and inertial navigation
CN114325610A (en) * 2021-11-29 2022-04-12 西安电子工程研究所 Radar installation error correction method based on dynamic measurement data
CN114413887A (en) * 2021-12-24 2022-04-29 北京理工大学前沿技术研究院 Method, equipment and medium for calibrating external parameters of sensor

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105548976A (en) * 2015-12-14 2016-05-04 中国科学院长春光学精密机械与物理研究所 Shipborne radar offshore precision identification method
KR101888171B1 (en) * 2017-11-16 2018-08-13 엘아이지넥스원 주식회사 Method and device for recognizing environment based on position information of unmanned surface vessel
CN111239766A (en) * 2019-12-27 2020-06-05 北京航天控制仪器研究所 Water surface multi-target rapid identification and tracking method based on laser radar
CN111521996A (en) * 2020-05-30 2020-08-11 上海工程技术大学 Laser radar installation calibration method
CN113721260A (en) * 2021-08-26 2021-11-30 南京邮电大学 Online combined calibration method for laser radar, binocular camera and inertial navigation
CN114325610A (en) * 2021-11-29 2022-04-12 西安电子工程研究所 Radar installation error correction method based on dynamic measurement data
CN114413887A (en) * 2021-12-24 2022-04-29 北京理工大学前沿技术研究院 Method, equipment and medium for calibrating external parameters of sensor

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
李树国;张海江;秦武;: "飞行器惯导数据在海上靶场测控中的应用", 无线电工程, no. 09, 5 September 2006 (2006-09-05) *
纪斌;: "主动雷达与惯导设备安装夹角的标校", 电讯技术, no. 08, 26 August 2020 (2020-08-26) *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115683170A (en) * 2023-01-04 2023-02-03 成都西物信安智能系统有限公司 Calibration method based on radar point cloud data fusion error

Similar Documents

Publication Publication Date Title
CN107451593B (en) High-precision GPS positioning method based on image feature points
Barjenbruch et al. Joint spatial-and Doppler-based ego-motion estimation for automotive radars
CN112346104B (en) Unmanned aerial vehicle information fusion positioning method
CN110132284B (en) Global positioning method based on depth information
CN112083387B (en) Radar calibration method and device
CN110850455B (en) Track recording method based on differential GPS and vehicle kinematics model
CN113238072B (en) Moving target resolving method suitable for vehicle-mounted photoelectric platform
CN116540285B (en) Inertial-assisted GNSS dual-antenna orientation method and device and electronic equipment
CN112904317A (en) Calibration method for multi-laser radar and GNSS-INS system
CN109282813B (en) Unmanned ship global obstacle identification method
CN111929676B (en) X-band radar target detection and tracking method based on density clustering
CN112540371A (en) Near-bottom multi-beam coordinate conversion processing method
CN115200608A (en) Method for calibrating installation error of water laser radar and inertial navigation
WO2023045182A1 (en) Positioning of target object
CN112581610B (en) Robust optimization method and system for building map from multi-beam sonar data
CN110908404B (en) AUV intelligent observation motion method based on data driving
CN113129377A (en) Three-dimensional laser radar rapid robust SLAM method and device
Jung et al. Terrain based navigation for an autonomous surface vehicle with a multibeam sonar
CN110849349A (en) Fusion positioning method based on magnetic sensor and wheel type odometer
CN116299163A (en) Unmanned aerial vehicle track planning method, unmanned aerial vehicle track planning device, unmanned aerial vehicle track planning equipment and unmanned aerial vehicle track planning medium
CN115857520A (en) Unmanned aerial vehicle carrier landing state monitoring method based on combination of vision and ship state
CN115761286A (en) Method for detecting navigation obstacle of unmanned surface vehicle based on laser radar under complex sea condition
CN115436968A (en) Bitmap repositioning method based on laser radar
Kwon et al. Radar velocity measurements aided navigation system for UAVs
WO2020244467A1 (en) Method and device for motion state estimation

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