Multi-sensor adaptive calibration method and system for unmanned vehicle and medium
Through the multi-sensor adaptive calibration method of unmanned vehicles, real-time sensor calibration is used to use environmental topology models and adaptive algorithms to perform real-time sensor calibration, solving the problem of traditional methods relying on calibration targets, achieving an efficient and flexible calibration process, and improving the autonomous vehicle real-time perception capability.
Patent Information
- Application Number
- CN202411194924.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-12-27
- Estimated Expiration
- 2044-08-29
AI Technical Summary
Traditional unmanned vehicle sensor calibration methods rely on calibration targets, increasing complexity and cost, and accuracy and stability affect the accuracy of calibration results.
Adaptive calibration method for multi-sensors is adopted to obtain environmental data in real time through vehicle cameras and lidars, build an environmental topology model, extract features using WLD local feature matching algorithm, combine adaptive calibration algorithm and BA algorithm to optimize internal and external parameters of the sensor to achieve no calibration required Real-time calibration of the target.
It reduces calibration costs and complexity, improves calibration flexibility and adaptability, realizes real-time calibration during vehicle driving, and enhances the real-time perception and robustness of autonomous vehicles.
Smart Images

Figure CN119199882A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of unmanned driving technology, and in particular to a multi-sensor adaptive calibration method, system and medium for an unmanned driving vehicle. Background Art
[0002] Autonomous driving technology is highly dependent on the collaborative work of multiple sensors, including cameras, millimeter-wave radars, and lidars. Traditional sensor calibration methods often rely on calibration targets and fixed calibration sites, which not only increases the complexity and cost of the calibration process, but also limits the choice of calibration scenarios. In addition, the accuracy and stability of the calibration target also directly affect the accuracy of the calibration results. Summary of the invention
[0003] In view of the above problems, the present invention provides a multi-sensor adaptive calibration method, system and medium for unmanned vehicles, which not only get rid of the dependence on calibration targets, reduce calibration costs and complexity, and improve the flexibility and adaptability of calibration, but also the calibration process can be carried out in real time during vehicle driving without interrupting driving, thereby improving the calibration efficiency and the real-time perception capability of the autonomous driving vehicle.
[0004] In order to achieve the above-mentioned purpose and other related purposes, the technical solution provided by the present invention is as follows:
[0005] A multi-sensor adaptive calibration method for an unmanned vehicle, the method comprising:
[0006] W1. The vehicle is driving on the road, and the image data information of the road is obtained in real time based on the vehicle-mounted camera, and the point cloud data information of the road is obtained in real time based on the vehicle-mounted laser radar, and a topological model of the environment around the vehicle is constructed, and the environmental data around the vehicle is topologically analyzed to obtain the topological data information of the environment around the vehicle;
[0007] W2. Based on the topological data information of the vehicle surroundings, the local feature matching algorithm based on WLD is used to extract features from the vehicle surroundings data, and a feature matrix of the vehicle surroundings is constructed to obtain feature matrix data information of the vehicle surroundings;
[0008] W3. Based on the characteristic matrix data information of the vehicle surrounding environment, an adaptive calibration algorithm is used to calculate the relative posture relationship between the sensors to obtain the relative posture relationship data information between the sensors;
[0009] W4. Based on the relative posture relationship data information between the sensors, the BA algorithm based on the adaptive adjustment factor is used to optimize and calibrate the internal and external parameters of the sensors to obtain the internal and external parameter data information of the calibrated sensors.
[0010] Furthermore, in step W1, the construction of the environmental topology model around the vehicle and characterization of the environmental data around the vehicle include:
[0011] W11. Based on the image data information of the road and the point cloud data information of the road, construct a fusion function Q of the road point cloud and the image,
[0012]
[0013] Among them, x is the image data information of the road, y is the point cloud data information of the road, α1, α2 and α3 are the feature fusion factors of the image and the point cloud, and the image and the point cloud of the road are fused to obtain the fused data information of the point cloud and the image of the road;
[0014] W12. Based on the fused data information of the point cloud and image of the road, establish the environmental topology function R around the vehicle,
[0015]
[0016] Among them, z is the fused data information of the road point cloud and image, β1, β2 and β3 are the topological factors of the vehicle's surrounding environment;
[0017] W13. Based on the environmental topology function R around the vehicle, the environmental data around the vehicle is topologically processed to obtain topological data information of the environment around the vehicle.
[0018] Furthermore, the topological factors β1, β2 and β3 of the vehicle surrounding environment are:
[0019]
[0020]
[0021]
[0022] Among them, z is the fused data information of the road point cloud and image.
[0023] Furthermore, in step W2, the extracting features of the data of the vehicle surrounding environment by using the WLD-based local feature matching algorithm includes:
[0024] W21. Based on the topological data information of the vehicle surrounding environment, establish a WLD local partition function U of the vehicle surrounding environment,
[0025]
[0026] Among them, a is the topological data information of the vehicle's surrounding environment, δ and γ are the local division weight coefficients of WLD, the vehicle's surrounding environment is divided to obtain the divided vehicle's surrounding environment data information;
[0027] W22. Based on the divided vehicle surrounding environment data information, establish a differential excitation operator function P of the vehicle surrounding environment,
[0028]
[0029] Among them, x i is the vehicle surrounding environment data information after division, x0 is the mean value data information of the vehicle surrounding environment after division, η i is the differential constant parameter of the vehicle surrounding environment after division, n is the sample capacity, and the differential excitation operator of the vehicle surrounding environment is characterized to obtain the differential excitation operator data information of the vehicle surrounding environment;
[0030] W23. Based on the differential excitation operator data information of the vehicle surrounding environment, establish a local feature matching function S of the vehicle surrounding environment,
[0031]
[0032] Among them, b is the differential excitation operator data information of the vehicle's surrounding environment, λ1, λ2 and λ3 are the feature matching factors of the vehicle's surrounding environment, feature extraction is performed on the data of the vehicle's surrounding environment, and a feature matrix of the vehicle's surrounding environment is constructed to obtain the feature matrix data information of the vehicle's surrounding environment.
[0033] Furthermore, the constraints of the vehicle surrounding environment feature matching factors λ1, λ2 and λ3 are:
[0034]
[0035] Furthermore, the mean data information x0 of the vehicle surrounding environment after the division is,
[0036]
[0037]
[0038] Among them, x i is the divided vehicle surrounding environment data information, n is the sample size, μ i is the gain constant parameter of the divided vehicle environment.
[0039] Furthermore, in step W3, the use of an adaptive calibration algorithm to calculate the relative posture relationship between sensors includes:
[0040] W31. Based on the characteristic matrix data information of the vehicle surrounding environment, a geometric relationship function F between the sensor and the vehicle surrounding environment is established.
[0041]
[0042] Among them, c is the characteristic matrix data information of the vehicle's surrounding environment, θ1 and θ2 are the geometric adjustment factors of the sensor and the vehicle's surrounding environment, and the geometric relationship between the sensor and the vehicle's surrounding environment is calculated to obtain the geometric relationship data information between the sensor and the vehicle's surrounding environment;
[0043] W32. Based on the geometric relationship data information between the sensor and the vehicle's surrounding environment, establish a relative posture function G between the sensors,
[0044]
[0045] Among them, r is the geometric relationship data information between the sensor and the vehicle's surrounding environment, ρ1, ρ2 and ρ3 are the relative posture error factors between sensors;
[0046] W33. Based on the relative posture function G between the sensors, the relative posture relationship between the sensors is calculated to obtain the relative posture relationship data information between the sensors.
[0047] Furthermore, in step W4, the optimization and calibration of the internal and external parameters of the sensor using the BA algorithm based on the adaptive adjustment factor includes:
[0048] W41. Based on the relative posture relationship data information between the sensors, the internal and external parameter matrix of the sensor is constructed, and the bat population is initialized to obtain the initialized bat population data information;
[0049] W42. Based on the initialized bat population data information, establish the fitness function L of the population individuals,
[0050]
[0051] Among them, g is the data information of the initialized bat population, σ1 and σ2 are the fitness determining factors of the individuals in the bat population, and the fitness values of the individuals in the population are calculated to obtain the fitness value data information of the individuals in the population;
[0052] W43. Based on the fitness value data information of the population individuals, establish the objective function V,
[0053] Among them, h is the fitness value data information of the population individual, ω1, ω2 and ω3 are the target optimization adaptive adjustment factors, and the internal and external parameters of the sensor are optimized and calibrated to obtain the internal and external parameter data information of the calibrated sensor.
[0054] In order to achieve the above-mentioned object and other related objects, the present invention also provides a system for implementing any one of the multi-sensor adaptive calibration methods for unmanned vehicles, the system comprising:
[0055] A sensor suite, including cameras and lidar, to sense the vehicle’s surroundings;
[0056] Data processing module, used to receive the raw data from each sensor and perform preprocessing, feature extraction and data analysis;
[0057] An adaptive calibration algorithm module is used to characterize the geometric relationship between natural features in the environment and sensors using an adaptive calibration algorithm, and to automatically calculate the relative position and posture relationship between sensors;
[0058] The control module is used to adjust the working parameters of the sensor according to the calibration results to ensure data synchronization and consistency between sensors.
[0059] In order to achieve the above-mentioned purpose and other related purposes, the present invention also provides a computer-readable storage medium, which stores a computer program programmed or configured to execute any one of the multi-sensor adaptive calibration methods for unmanned vehicles.
[0060] The present invention has the following positive effects:
[0061] 1. The present invention constructs an environmental topology model around the vehicle, performs topology on the environmental data around the vehicle, and uses a local feature matching algorithm based on WLD to extract features from the data of the vehicle's surrounding environment. This not only gets rid of the dependence on calibration targets, reduces calibration costs and complexity, and improves calibration flexibility and adaptability, but also can adapt to sensors of different models and different precisions, as well as complex and changeable environmental conditions, thereby improving the robustness and reliability of the autonomous driving system.
[0062] 2. The present invention adopts an adaptive calibration algorithm to calculate the relative posture relationship between sensors, and combines the BA algorithm based on adaptive adjustment factors to optimize and calibrate the internal and external parameters of the sensors. Not only can the calibration process be carried out in real time during vehicle driving without interrupting driving, thereby improving the calibration efficiency and the real-time perception capability of the autonomous driving vehicle, but the adaptive calibration algorithm and complex optimization technology ensure the accuracy and stability of the calibration results. BRIEF DESCRIPTION OF THE DRAWINGS
[0063] Figure 1 It is a schematic diagram of the method flow of the present invention;
[0064] Figure 2 A schematic diagram of a process of constructing an environmental topology model around a vehicle according to the present invention;
[0065] Figure 3 It is a flow chart of the local feature matching algorithm based on WLD of the present invention;
[0066] Figure 4 It is a schematic diagram of the process flow of the adaptive calibration algorithm of the present invention;
[0067] Figure 5 It is a schematic diagram of the process of the BA algorithm based on the adaptive adjustment factor of the present invention;
[0068] Figure 6 It is a schematic diagram of the system framework of the present invention. DETAILED DESCRIPTION
[0069] The following is a description of exemplary embodiments of the present disclosure in conjunction with the accompanying drawings, including various details of the embodiments of the present disclosure to facilitate understanding, which should be considered as merely exemplary. Therefore, it should be recognized by those of ordinary skill in the art that various changes and modifications may be made to the embodiments described herein without departing from the scope and spirit of the present disclosure. Similarly, for the sake of clarity and conciseness, descriptions of well-known functions and structures are omitted in the following description.
[0070] Example 1: Figure 1 As shown, a multi-sensor adaptive calibration method for an unmanned vehicle, the method comprising:
[0071] W1. The vehicle is driving on the road, and the image data information of the road is obtained in real time based on the vehicle-mounted camera, and the point cloud data information of the road is obtained in real time based on the vehicle-mounted laser radar, and a topological model of the environment around the vehicle is constructed, and the environmental data around the vehicle is topologically analyzed to obtain the topological data information of the environment around the vehicle;
[0072] W2. Based on the topological data information of the vehicle surroundings, the local feature matching algorithm based on WLD is used to extract features from the vehicle surroundings data, and a feature matrix of the vehicle surroundings is constructed to obtain feature matrix data information of the vehicle surroundings;
[0073] W3. Based on the characteristic matrix data information of the vehicle surrounding environment, an adaptive calibration algorithm is used to calculate the relative posture relationship between the sensors to obtain the relative posture relationship data information between the sensors;
[0074] W4. Based on the relative posture relationship data information between the sensors, the BA algorithm based on the adaptive adjustment factor is used to optimize and calibrate the internal and external parameters of the sensors to obtain the internal and external parameter data information of the calibrated sensors.
[0075] In this embodiment, if Figure 2 As shown, in step W1, the construction of the environmental topology model around the vehicle and the characterization of the environmental data around the vehicle include:
[0076] W11. Based on the image data information of the road and the point cloud data information of the road, construct a fusion function Q of the road point cloud and the image,
[0077]
[0078] Among them, x is the image data information of the road, y is the point cloud data information of the road, α1, α2 and α3 are the feature fusion factors of the image and the point cloud, and the image and the point cloud of the road are fused to obtain the fused data information of the point cloud and the image of the road;
[0079] W12. Based on the fused data information of the point cloud and image of the road, establish the environmental topology function R around the vehicle,
[0080]
[0081] Among them, z is the fused data information of the road point cloud and image, β1, β2 and β3 are the topological factors of the vehicle's surrounding environment;
[0082] W13. Based on the environmental topology function R around the vehicle, the environmental data around the vehicle is topologically processed to obtain topological data information of the environment around the vehicle.
[0083] In this embodiment, the topological factors β1, β2 and β3 of the vehicle surrounding environment are:
[0084]
[0085]
[0086] Among them, z is the fused data information of the road point cloud and image.
[0087] In this embodiment, if Figure 3 As shown, in step W2, the use of the WLD-based local feature matching algorithm to extract features from the data of the vehicle's surrounding environment includes:
[0088] W21. Based on the topological data information of the vehicle surrounding environment, establish a WLD local partition function U of the vehicle surrounding environment,
[0089]
[0090] Among them, a is the topological data information of the vehicle's surrounding environment, δ and γ are the local division weight coefficients of WLD, the vehicle's surrounding environment is divided to obtain the divided vehicle's surrounding environment data information;
[0091] W22. Based on the divided vehicle surrounding environment data information, establish a differential excitation operator function P of the vehicle surrounding environment,
[0092]
[0093] Among them, x i is the vehicle surrounding environment data information after division, x0 is the mean value data information of the vehicle surrounding environment after division, η i is the differential constant parameter of the vehicle surrounding environment after division, n is the sample capacity, and the differential excitation operator of the vehicle surrounding environment is characterized to obtain the differential excitation operator data information of the vehicle surrounding environment;
[0094] W23. Based on the differential excitation operator data information of the vehicle surrounding environment, establish a local feature matching function S of the vehicle surrounding environment,
[0095]
[0096] Among them, b is the differential excitation operator data information of the vehicle's surrounding environment, λ1, λ2 and λ3 are the feature matching factors of the vehicle's surrounding environment, feature extraction is performed on the data of the vehicle's surrounding environment, and a feature matrix of the vehicle's surrounding environment is constructed to obtain the feature matrix data information of the vehicle's surrounding environment.
[0097] In this embodiment, the constraints of the vehicle surrounding environment feature matching factors λ1, λ2 and λ3 are:
[0098]
[0099] In this embodiment, the mean data information x0 of the vehicle surrounding environment after division is,
[0100]
[0101] Among them, x i is the divided vehicle surrounding environment data information, n is the sample size, μ i is the gain constant parameter of the divided vehicle environment.
[0102] Example 2: Based on the multi-sensor adaptive calibration method for an unmanned vehicle in Example 1, the present invention is further illustrated and described below.
[0103] like Figure 1 As shown, a multi-sensor adaptive calibration method for an unmanned vehicle, the method comprising:
[0104] W1. The vehicle is driving on the road, and the image data information of the road is obtained in real time based on the vehicle-mounted camera, and the point cloud data information of the road is obtained in real time based on the vehicle-mounted laser radar, and a topological model of the environment around the vehicle is constructed, and the environmental data around the vehicle is topologically analyzed to obtain the topological data information of the environment around the vehicle;
[0105] W2. Based on the topological data information of the vehicle surroundings, the local feature matching algorithm based on WLD is used to extract features from the vehicle surroundings data, and a feature matrix of the vehicle surroundings is constructed to obtain feature matrix data information of the vehicle surroundings;
[0106] W3. Based on the characteristic matrix data information of the vehicle surrounding environment, an adaptive calibration algorithm is used to calculate the relative posture relationship between the sensors to obtain the relative posture relationship data information between the sensors;
[0107] W4. Based on the relative posture relationship data information between the sensors, the BA algorithm based on the adaptive adjustment factor is used to optimize and calibrate the internal and external parameters of the sensors to obtain the internal and external parameter data information of the calibrated sensors.
[0108] In this embodiment, if Figure 4 As shown, in step W3, the use of the adaptive calibration algorithm to calculate the relative posture relationship between the sensors includes:
[0109] W31. Based on the characteristic matrix data information of the vehicle surrounding environment, a geometric relationship function F between the sensor and the vehicle surrounding environment is established.
[0110]
[0111] Among them, c is the characteristic matrix data information of the vehicle's surrounding environment, θ1 and θ2 are the geometric adjustment factors of the sensor and the vehicle's surrounding environment, and the geometric relationship between the sensor and the vehicle's surrounding environment is calculated to obtain the geometric relationship data information between the sensor and the vehicle's surrounding environment;
[0112] W32. Based on the geometric relationship data information between the sensor and the vehicle's surrounding environment, establish a relative posture function G between the sensors,
[0113]
[0114] Among them, r is the geometric relationship data information between the sensor and the vehicle's surrounding environment, ρ1, ρ2 and ρ3 are the relative posture error factors between sensors;
[0115] W33. Based on the relative posture function G between the sensors, the relative posture relationship between the sensors is calculated to obtain the relative posture relationship data information between the sensors.
[0116] In this embodiment, if Figure 5 As shown, in step W4, the optimization and calibration of the internal and external parameters of the sensor using the BA algorithm based on the adaptive adjustment factor includes:
[0117] W41. Based on the relative posture relationship data information between the sensors, the internal and external parameter matrix of the sensor is constructed, and the bat population is initialized to obtain the initialized bat population data information;
[0118] W42. Based on the initialized bat population data information, establish the fitness function L of the population individuals,
[0119]
[0120] Among them, g is the data information of the initialized bat population, σ1 and σ2 are the fitness determining factors of the individuals in the bat population, and the fitness values of the individuals in the population are calculated to obtain the fitness value data information of the individuals in the population;
[0121] W43. Based on the fitness value data information of the population individuals, establish the objective function V,
[0122] Among them, h is the fitness value data information of the population individual, ω1, ω2 and ω3 are the target optimization adaptive adjustment factors, and the internal and external parameters of the sensor are optimized and calibrated to obtain the internal and external parameter data information of the calibrated sensor.
[0123] In this embodiment, if Figure 6 As shown, the present invention provides a system for implementing any one of the multi-sensor adaptive calibration methods for unmanned vehicles, the system comprising:
[0124] A sensor suite, including cameras and lidar, to sense the vehicle’s surroundings;
[0125] Data processing module, used to receive the raw data from each sensor and perform preprocessing, feature extraction and data analysis;
[0126] An adaptive calibration algorithm module is used to characterize the geometric relationship between natural features in the environment and sensors using an adaptive calibration algorithm, and to automatically calculate the relative position and posture relationship between sensors;
[0127] The control module is used to adjust the working parameters of the sensor according to the calibration results to ensure data synchronization and consistency between sensors.
[0128] In this embodiment, the present invention provides a computer-readable storage medium, on which is stored a computer program programmed or configured to execute any one of the multi-sensor adaptive calibration methods for an unmanned vehicle.
[0129] Any reference to memory, storage, database or other media used in the embodiments provided in the present application may include non-volatile and / or volatile memory. Non-volatile memory may include read-only memory (ROM), programmable ROM (PROM), electrically programmable ROM (EPROM), electrically erasable programmable ROM (EEPROM) or flash memory. Volatile memory may include random access memory (RAM) or external cache memory. As an illustration and not limitation, RAM is available in various forms, such as static RAM (SRAM), dynamic RAM (DRAM), synchronous DRAM (SDRAM), double data rate SDRAM (DDRSDRAM), enhanced SDRAM (ESDRAM), synchronous link (Synchlink) DRAM (SLDRAM), memory bus (Rambus) direct RAM (RDRAM), direct memory bus dynamic RAM (DRDRAM) and memory bus dynamic RAM (RDRAM).
[0130] In summary, the present invention not only gets rid of the dependence on calibration targets, reduces calibration costs and complexity, and improves the flexibility and adaptability of calibration, but also the calibration process can be carried out in real time during vehicle driving without interrupting driving, thereby improving the calibration efficiency and the real-time perception capability of the autonomous driving vehicle.
[0131] The above specific implementations do not constitute a limitation on the protection scope of the present disclosure. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present disclosure shall be included in the protection scope of the present disclosure.
Claims
1. A multi-sensor adaptive calibration method for an unmanned vehicle, characterized in that: The method comprises: W1. The vehicle is driving on the road, and the image data information of the road is obtained in real time based on the vehicle-mounted camera, and the point cloud data information of the road is obtained in real time based on the vehicle-mounted laser radar, and a topological model of the environment around the vehicle is constructed, and the environmental data around the vehicle is topologically analyzed to obtain the topological data information of the environment around the vehicle; W2. Based on the topological data information of the vehicle surroundings, the local feature matching algorithm based on WLD is used to extract features from the vehicle surroundings data, and a feature matrix of the vehicle surroundings is constructed to obtain feature matrix data information of the vehicle surroundings; W3. Based on the characteristic matrix data information of the vehicle surrounding environment, an adaptive calibration algorithm is used to calculate the relative posture relationship between sensors to obtain the relative posture relationship data information between sensors; W4. Based on the relative posture relationship data information between the sensors, the BA algorithm based on the adaptive adjustment factor is used to optimize and calibrate the internal and external parameters of the sensors to obtain the internal and external parameter data information of the calibrated sensors.
2. The multi-sensor adaptive calibration method for an unmanned vehicle according to claim 1, characterized in that: In step W1, the construction of the environmental topology model around the vehicle and characterization of the environmental data around the vehicle include: W11. Based on the image data information of the road and the point cloud data information of the road, construct a fusion function Q of the road point cloud and the image, Among them, x is the image data information of the road, y is the point cloud data information of the road, α1, α2 and α3 are the feature fusion factors of the image and the point cloud, and the image and the point cloud of the road are fused to obtain the fused data information of the point cloud and the image of the road; W12. Based on the fused data information of the point cloud and image of the road, establish the environmental topology function R around the vehicle, Among them, z is the fused data information of the road point cloud and image, β1, β2 and β3 are the topological factors of the vehicle's surrounding environment; W13. Based on the environmental topology function R around the vehicle, the environmental data around the vehicle is topologically processed to obtain topological data information of the environment around the vehicle.
3. The multi-sensor adaptive calibration method for an unmanned vehicle according to claim 2, characterized in that: The topological factors β1, β2 and β3 of the vehicle surroundings are, Among them, z is the fused data information of the road point cloud and image.
4. The multi-sensor adaptive calibration method for an unmanned vehicle according to claim 1, characterized in that: In step W2, the feature extraction of the vehicle surrounding environment data using the WLD-based local feature matching algorithm includes: W21. Based on the topological data information of the vehicle surrounding environment, establish a WLD local partition function U of the vehicle surrounding environment, Among them, a is the topological data information of the vehicle's surrounding environment, δ and γ are the local division weight coefficients of WLD, the vehicle's surrounding environment is divided to obtain the divided vehicle's surrounding environment data information; W22. Based on the divided vehicle surrounding environment data information, establish a differential excitation operator function P of the vehicle surrounding environment, Among them, x i is the vehicle surrounding environment data information after division, x0 is the mean value data information of the vehicle surrounding environment after division, η i is the differential constant parameter of the vehicle surrounding environment after division, n is the sample capacity, and the differential excitation operator of the vehicle surrounding environment is characterized to obtain the differential excitation operator data information of the vehicle surrounding environment; W23. Based on the differential excitation operator data information of the vehicle surrounding environment, establish a local feature matching function S of the vehicle surrounding environment, Among them, b is the differential excitation operator data information of the vehicle's surrounding environment, λ1, λ2 and λ3 are the feature matching factors of the vehicle's surrounding environment, feature extraction is performed on the data of the vehicle's surrounding environment, and a feature matrix of the vehicle's surrounding environment is constructed to obtain the feature matrix data information of the vehicle's surrounding environment.
5. The multi-sensor adaptive calibration method for an unmanned vehicle according to claim 4, characterized in that: The constraints of the vehicle surrounding environment feature matching factors λ1, λ2 and λ3 are:
6. The multi-sensor adaptive calibration method for an unmanned vehicle according to claim 4, characterized in that: The mean data information x0 of the vehicle surrounding environment after the division is, Among them, x i is the divided vehicle surrounding environment data information, n is the sample size, μ i is the gain constant parameter of the divided vehicle environment.
7. The multi-sensor adaptive calibration method for an unmanned vehicle according to claim 1, characterized in that: In step W3, the use of an adaptive calibration algorithm to calculate the relative posture relationship between sensors includes: W31. Based on the characteristic matrix data information of the vehicle surrounding environment, a geometric relationship function F between the sensor and the vehicle surrounding environment is established. Among them, c is the characteristic matrix data information of the vehicle's surrounding environment, θ1 and θ2 are the geometric adjustment factors of the sensor and the vehicle's surrounding environment, and the geometric relationship between the sensor and the vehicle's surrounding environment is calculated to obtain the geometric relationship data information between the sensor and the vehicle's surrounding environment; W32. Based on the geometric relationship data information between the sensor and the vehicle's surrounding environment, establish a relative posture function G between the sensors, Among them, r is the geometric relationship data information between the sensor and the vehicle's surrounding environment, ρ1, ρ2 and ρ3 are the relative posture error factors between sensors; W33. Based on the relative posture function G between the sensors, the relative posture relationship between the sensors is calculated to obtain the relative posture relationship data information between the sensors.
8. The multi-sensor adaptive calibration method for an unmanned vehicle according to claim 1, characterized in that: In step W4, the optimization and calibration of the internal and external parameters of the sensor using the BA algorithm based on the adaptive adjustment factor includes: W41. Based on the relative posture relationship data information between the sensors, the internal and external parameter matrix of the sensor is constructed, and the bat population is initialized to obtain the initialized bat population data information; W42. Based on the initialized bat population data information, establish the fitness function L of the population individuals, Among them, g is the data information of the initialized bat population, σ1 and σ2 are the fitness determining factors of the individuals in the bat population, and the fitness values of the individuals in the population are calculated to obtain the fitness value data information of the individuals in the population; W43. Based on the fitness value data information of the population individuals, establish the objective function V, Among them, h is the fitness value data information of the population individual, ω1, ω2 and ω3 are the adaptive adjustment factors of the target optimization, and the internal and external parameters of the sensor are optimized and calibrated to obtain the internal and external parameter data information of the calibrated sensor.
9. A system for implementing the multi-sensor adaptive calibration method for an unmanned vehicle according to any one of claims 1 to 8, characterized in that: The system comprises: A sensor suite, including cameras and lidar, to sense the vehicle’s surroundings; Data processing module, used to receive the raw data from each sensor and perform preprocessing, feature extraction and data analysis; An adaptive calibration algorithm module is used to characterize the geometric relationship between natural features in the environment and sensors using an adaptive calibration algorithm, and to automatically calculate the relative position and posture relationship between sensors; The control module is used to adjust the working parameters of the sensor according to the calibration results to ensure data synchronization and consistency between sensors.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program that is programmed or configured to execute the multi-sensor adaptive calibration method for an unmanned vehicle as described in any one of claims 1 to 8.
Citation Information
Patent Citations
Multi-sensor fusion data processing method and device and multi-sensor fusion method
CN117113284A
Calibration verification method and device, storage medium and electronic equipment
CN118033560A
Multi-sensor joint calibration method and system for intelligent driving scene
CN118377024A
Data processing method and device based on multi-sensor fusion, and multi-sensor fusion method
US20210012165A1
Self-Calibration for Decoration Based Sensor Fusion Method
US20230351768A1
Cited By
Multi-sensor collaborative calibration method based on intelligent connected automobile
CN121067910A