Inertial measurement unit data processing method and device and electronic equipment
By dynamically adjusting the filter coefficients and using fast and slow filters to process IMU sensor data, the signal interference problem in the vehicle braking system is solved, and the filtering effect and system stability are improved.
Patent Information
- Application Number
- CN202411100393.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-12
- Publication Date
- 2024-11-08
AI Technical Summary
In existing vehicle braking systems, IMU signals are susceptible to vibration and environmental noise interference, resulting in the problem of fixed filter filter parameters, which may amplify noise or fail to effectively filter out interference.
By acquiring IMU sensor data in real time, calibrating and converting it into vehicle centroid acceleration data, filtering is performed using fast and slow filters, and weighting is performed according to the filter data difference and scale factor, and the filter coefficient is dynamically adjusted to adapt to signal characteristics.
More effective signal filtering is realized, reducing the phase lag of the filter, ensuring that the system maintains stable performance under different working conditions, and avoiding system instability or performance degradation caused by improper filter coefficients.
Smart Images

Figure CN118913263A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of vehicle braking technology, and in particular to an inertial measurement unit data processing method, device and electronic equipment. Background Art
[0002] In modern vehicle braking systems, IMU (Inertial Measurement Unit) sensors are used to measure the acceleration and angular velocity of the vehicle and calculate the corresponding position and attitude of the vehicle. Vibration and environmental noise during vehicle driving can also interfere with the IMU signal and affect the performance of the braking system.
[0003] Filtering the IMU signal through a filter can filter out noise and interference, however, the filtering effect of the filter is affected by the filtering parameters. In the related art, the filtering parameters of the filter are fixed, which may amplify the noise or fail to effectively filter out the interference. Summary of the invention
[0004] In order to solve the above technical problems, the present application provides an inertial measurement unit data processing method, device, electronic device and storage medium.
[0005] According to a first aspect of the present application, a method for processing inertial measurement unit data is provided, comprising:
[0006] Acquire inertial measurement unit (IMU) sensor data in real time, and calibrate the IMU sensor data using reference data to obtain calibrated IMU sensor data;
[0007] Extracting acceleration data from the calibration IMU sensor data, and converting the acceleration data into center-of-mass acceleration data at the center of mass of the vehicle;
[0008] Using a fast filter to filter the centroid acceleration data to obtain first filtered acceleration data;
[0009] Filtering the centroid acceleration data using a slow filter to obtain second filtered acceleration data; wherein the filter coefficient of the fast filter is greater than the filter coefficient of the slow filter;
[0010] Determine the filter scale factor corresponding to the difference between the first filtered acceleration data and the second filtered acceleration data based on a pre-established mapping relationship between the filter data difference and the filter scale factor;
[0011] According to the filter scale factor, weighting processing is performed on the filter coefficient of the fast filter and the filter coefficient of the slow filter to obtain a target filter coefficient;
[0012] The target filter coefficient is used as the filter coefficient of a first-order low-pass filter, and the center-of-mass acceleration data is filtered using the first-order low-pass filter to obtain target filtered acceleration data.
[0013] Optionally, after extracting acceleration data from the calibration IMU sensor data, the method further comprises:
[0014] Based on the vehicle's roll angle, detect whether the vehicle is in a state of violent movement;
[0015] If the vehicle is in a violent motion state, based on the roll angle, the center of mass acceleration data at the center of mass of the vehicle is compensated to obtain compensated acceleration data;
[0016] The filtering process of the centroid acceleration data by using a fast filter specifically includes:
[0017] Using a fast filter to filter the compensated acceleration data;
[0018] The filtering process of the centroid acceleration data by using a slow filter specifically includes:
[0019] The compensated acceleration data is filtered using a slow filter.
[0020] Optionally, compensating the center-of-mass acceleration data at the center of mass of the vehicle based on the roll angle to obtain compensated acceleration data includes:
[0021] Assume that β represents the roll angle of the vehicle, a cen represents the center of mass acceleration data at the center of mass of the vehicle;
[0022] Based on the pre-established mapping relationship between the roll angle and the roll angle compensation coefficient, the roll angle compensation coefficient k corresponding to the roll angle β is determined. β ;
[0023] According to the formula: a y_cor =a cen *(1-k β );
[0024] Determine the compensation acceleration data a y_cor .
[0025] Optionally, converting the acceleration data into center-of-mass acceleration data at the center of mass of the vehicle comprises:
[0026] Assume a mea Represents the acceleration data at the IMU installation location in the vehicle, L x Indicates the longitudinal distance between the IMU installation position and the vehicle's center of mass, L yrepresents the lateral distance between the IMU installation position and the vehicle's center of mass, Yrs represents the vehicle's yaw rate, and D Yrs represents the yaw angular acceleration;
[0027] According to the formula: a cen =a mea -L x *D Yrs +L y *Yrs 2 ;
[0028] Determine the center of mass acceleration data a at the center of mass of the vehicle cen .
[0029] Optionally, performing weighted processing on the filter coefficients of the fast filter and the slow filter according to the filter scale factor to obtain the target filter coefficients includes:
[0030] Assume k rab (t+1) represents the filter scaling factor, k fast represents the filter coefficient of the fast filter, k slow represents the filter coefficient of the slow filter, according to the following formula:
[0031] k self (t+1)=k arb (t+1)*k slow +(1-k arb (t+1))*k fast ;
[0032] K fast and k slow Perform weighted processing to obtain the target filter coefficient k self ;
[0033] Among them, the filter data difference and the filter scale factor k rab Negatively correlated.
[0034] Optionally, before filtering the centroid acceleration data using a fast filter, the method further includes:
[0035] Get the preset filter factor P 1 , P 2 and P 3 , according to the formula:
[0036] k fast =1-(P 1 / (P 1 +P 2 )); Determine the filter coefficient k of the fast filter fast ;
[0037] According to the formula: k slow =1-(P 3 *P 1 / (P 3 *P 1 +P 2 )); Determine the filter coefficient k of the slow filter slow .
[0038] Optionally, the filtering the centroid acceleration data using a fast filter to obtain first filtered acceleration data includes:
[0039] Assume a raw (t) represents the center of mass acceleration data, k fast represents the filter coefficient of the fast filter, k slow Represents the filter coefficient of the slow filter, a fast (t) represents the first filtered acceleration data calculated at the previous moment, a slow (t) represents the second filtered acceleration data calculated at the previous moment;
[0040] According to the formula: a fast (t+1)=a fast (t)+k fast *(a raw (t)-a fast (t));
[0041] Get the first filtered acceleration data a fast (t+1);
[0042] The filtering process of the centroid acceleration data by using a slow filter to obtain second filtered acceleration data includes:
[0043] According to the formula: a slow (t+1)=a slow (t)+k slow *(a raw (t)-a slow (t));
[0044] Get the second filtered acceleration data a slow (t+1).
[0045] Optionally, the filtering the centroid acceleration data using the first-order low-pass filter to obtain target filtered acceleration data includes:
[0046] Assume a raw (t) represents the center of mass acceleration data, a self (t) represents the target filtered acceleration data at the previous moment, k self(t+1) represents the target filter coefficient;
[0047] According to the formula: a self (t+1)=a self (t)+k self (t+1)*(a raw (t)-a self (t));
[0048] Determine the target filtered acceleration data a self (t+1).
[0049] According to a second aspect of the present application, an inertial measurement unit data processing device is provided, comprising:
[0050] IMU sensor data acquisition module, used to acquire inertial measurement unit IMU sensor data in real time;
[0051] An IMU sensor data calibration module, used to calibrate the IMU sensor data using reference data to obtain calibrated IMU sensor data;
[0052] An acceleration data conversion module, used to extract acceleration data from the calibration IMU sensor data, and convert the acceleration data into center of mass acceleration data at the center of mass of the vehicle;
[0053] A fast filtering module, used for filtering the centroid acceleration data using a fast filter to obtain first filtered acceleration data;
[0054] A slow filtering module, used for filtering the centroid acceleration data using a slow filter to obtain second filtered acceleration data; wherein the filtering coefficient of the fast filter is greater than the filtering coefficient of the slow filter;
[0055] A filter scale factor determination module, configured to determine a filter scale factor corresponding to a difference between the first filtered acceleration data and the second filtered acceleration data based on a pre-established mapping relationship between a filter data difference and a filter scale factor;
[0056] A target filter coefficient determination module, used for performing weighted processing on the filter coefficient of the fast filter and the filter coefficient of the slow filter according to the filter scale factor to obtain a target filter coefficient;
[0057] The first-order low-pass filter module is used to use the target filter coefficient as the filter coefficient of the first-order low-pass filter, and use the first-order low-pass filter to filter the center of mass acceleration data to obtain target filtered acceleration data.
[0058] Optionally, the inertial measurement unit data processing device further includes:
[0059] A state detection module is used to detect whether the vehicle is in a violent motion state based on the vehicle's roll angle;
[0060] an acceleration data compensation module, for compensating the mass center acceleration data at the mass center of the vehicle based on the roll angle to obtain compensated acceleration data if the state detection module determines that the vehicle is in a violent motion state;
[0061] The fast filtering module is specifically used to filter the compensated acceleration data using a fast filter to obtain first filtered acceleration data;
[0062] The slow filtering module is specifically used to filter the compensated acceleration data using a slow filter to obtain second filtered acceleration data.
[0063] Alternatively, let β represent the roll angle of the vehicle, a cen represents the center of mass acceleration data at the center of mass of the vehicle; the acceleration data compensation module is specifically used to determine the roll angle compensation coefficient k corresponding to the roll angle β based on the pre-established mapping relationship between the roll angle and the roll angle compensation coefficient β ;as well as,
[0064] According to the formula: a y_cor =a cen *(1-k β );Determine the compensation acceleration data a y_cor .
[0065] Alternatively, assuming a mea Represents the acceleration data at the IMU installation location in the vehicle, L x Indicates the longitudinal distance between the IMU installation position and the vehicle's center of mass, L y represents the lateral distance between the IMU installation position and the vehicle's center of mass, Yrs represents the vehicle's yaw rate, and D Yrs represents the yaw angular acceleration;
[0066] The acceleration data conversion module is specifically used according to the formula:
[0067] a cen =a mea -L x *D Yrs +L y *Yrs 2 ; Determine the center of mass acceleration data a at the center of mass of the vehicle cen .
[0068] Alternatively, assume that k rab (t+1) represents the filter scaling factor, k fastrepresents the filter coefficient of the fast filter, k slow represents the filter coefficient of the slow filter, and the target filter coefficient determination module is specifically used according to the following formula:
[0069] k self (t+1)=k arb (t+1)*k slow +(1-k arb (t+1))*k fast ;
[0070] K fast and k slow Perform weighted processing to obtain the target filter coefficient k self ;
[0071] Among them, the filter data difference and the filter scale factor k rab Negatively correlated.
[0072] Optionally, the inertial measurement unit data processing device further includes:
[0073] The filter factor acquisition module is used to obtain the preset filter factor P 1 , P 2 and P 3 ;
[0074] The filter coefficient determination module of the fast filter is used to determine the filter coefficient according to the formula:
[0075] k fast =1-(P 1 / (P 1 +P 2 )); Determine the filter coefficient k of the fast filter fast ;
[0076] The filter coefficient determination module of the slow filter is used to determine the filter coefficient according to the formula:
[0077] k slow =1-(P 3 *P 1 / (P 3 *P 1 +P 2 )); Determine the filter coefficient k of the slow filter slow .
[0078] Alternatively, assuming a raw (t) represents the center of mass acceleration data, k fast represents the filter coefficient of the fast filter, k slow Represents the filter coefficient of the slow filter, a fast (t) represents the first filtered acceleration data calculated at the previous moment, aslow (t) represents the second filtered acceleration data calculated at the previous moment;
[0079] The fast filtering module is specifically used according to the formula:
[0080] a fast (t+1)=a fast (t)+k fast *(a raw (t)-a fast (t));
[0081] Get the first filtered acceleration data a fast (t+1);
[0082] The slow filtering module is specifically used according to the formula:
[0083] a slow (t+1)=a slow (t)+k slow *(a raw (t)-a slow (t));
[0084] Get the second filtered acceleration data a slow (t+1).
[0085] Alternatively, assuming a raw (t) represents the center of mass acceleration data, a self (t) represents the target filtered acceleration data at the previous moment, k self (t+1) represents the target filter coefficient;
[0086] The first-order low-pass filter module is used to use the target filter coefficient as the filter coefficient of the first-order low-pass filter, and according to the formula: a self (t+1)=a self (t)+k self (t+1)*(a raw (t)-a self (t));
[0087] Determine the target filtered acceleration data a self (t+1).
[0088] According to a third aspect of the present application, an electronic device is provided, comprising: a processor, wherein the processor is configured to execute a computer program stored in a memory, wherein the computer program implements the method described in the first aspect when executed by the processor.
[0089] According to a fourth aspect of the present application, a computer-readable storage medium is provided, on which a computer program is stored. When the computer program is executed by a processor, the method described in the first aspect is implemented.
[0090] According to a fifth aspect of the present application, a computer program product is provided. When the computer program product is run on a computer, the computer is enabled to execute the method described in the first aspect.
[0091] Compared with the prior art, the technical solution provided by the embodiments of the present application has the following advantages:
[0092] The IMU sensor data is acquired in real time, and the IMU sensor data is calibrated to obtain the calibrated IMU sensor data. The acceleration data is extracted from the calibrated IMU sensor data, and the acceleration data is converted into the center of mass acceleration data at the center of mass of the vehicle. The center of mass acceleration data is filtered by a fast filter and a slow filter respectively to obtain the first filtered acceleration data and the second filtered acceleration data. The filter coefficient of the fast filter is greater than the filter coefficient of the slow filter. Therefore, the filtering of the slow filter is relatively gentle, and the fluctuation of the fast filter is large. By comparing the difference between the two, the speed of the signal change can be analyzed, so as to select the appropriate filter proportional factor, and then calculate the appropriate target filter coefficient. By dynamically adjusting the filter coefficient, the filtering effect can be adjusted in real time according to the change of the signal, so that the filter can be more adapted to different signal characteristics. The first-order low-pass filter has the disadvantage of phase lag. Dynamically adjusting the filter coefficient can reduce this lag to a certain extent, making the filtering result closer to the actual signal, and ensuring that the system maintains stable performance under different working conditions, avoiding system instability or performance degradation caused by improper filter coefficients. BRIEF DESCRIPTION OF THE DRAWINGS
[0093] The accompanying drawings, which are incorporated in and constitute a part of this specification, illustrate embodiments consistent with the present application and, together with the description, serve to explain the principles of the present application.
[0094] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, for ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative labor.
[0095] Figure 1 A flow chart of an inertial measurement unit data processing method in an embodiment of the present application;
[0096] Figure 2 is another flow chart of the inertial measurement unit data processing method in the embodiment of the present application;
[0097] Figure 3 A schematic diagram of the structure of an inertial measurement unit data processing device in an embodiment of the present application;
[0098] Figure 4 A schematic diagram of the structure of an electronic device in an embodiment of the present application. DETAILED DESCRIPTION
[0099] In order to more clearly understand the above-mentioned purposes, features and advantages of the present application, the scheme of the present application will be further described below. It should be noted that the embodiments of the present application and the features in the embodiments can be combined with each other without conflict.
[0100] In the following description, many specific details are set forth to facilitate a full understanding of the present application, but the present application may also be implemented in other ways different from those described herein; obviously, the embodiments in the specification are only part of the embodiments of the present application, rather than all of the embodiments.
[0101] See also Figure 1 , Figure 1 This is a flow chart of the inertial measurement unit data processing method in an embodiment of the present application, which may include the following steps:
[0102] Step S102, acquiring IMU sensor data in real time, and calibrating the IMU sensor data using reference data to obtain calibrated IMU sensor data.
[0103] IMU sensor data includes: acceleration data and angular velocity data of the vehicle. IMU sensor data usually has errors, so reference data can be obtained from the application layer to calibrate the acceleration data and angular velocity data in the IMU sensor data through parameter data.
[0104] Step S104, extracting acceleration data from the calibration IMU sensor data, and converting the acceleration data into center of mass acceleration data at the center of mass of the vehicle.
[0105] Since the data processing methods of acceleration data and angular velocity data are different, this application only filters the acceleration data and does not process the angular velocity data. The acceleration data is the data measured at the installation position of the IMU sensor. It is inaccurate to directly use the acceleration data as the acceleration data of the vehicle. Therefore, the acceleration data can be converted into the center of mass acceleration data at the center of mass of the vehicle, and the center of mass acceleration data is the acceleration of the vehicle.
[0106] Alternatively, assuming a mea Represents the acceleration data at the IMU installation location in the vehicle, that is, the calibrated acceleration data, L x Indicates the longitudinal distance between the IMU installation position and the vehicle's center of mass, L yrepresents the lateral distance between the IMU installation position and the vehicle's center of mass, Yrs represents the vehicle's yaw rate, and D Yrs represents the yaw angular acceleration;
[0107] According to the formula: a cen =a mea -L x *D Yrs +L y *Yrs 2 ;
[0108] Determine the center of mass acceleration data a at the center of mass of the vehicle cen .
[0109] Step S106: Filter the centroid acceleration data using a fast filter to obtain first filtered acceleration data.
[0110] In the embodiment of the present application, two filters (a fast filter and a slow filter) can be used to filter the centroid acceleration data. The filter coefficient of the fast filter is greater than the filter coefficient of the slow filter. Therefore, the slow filter filters more smoothly, and the fast filter fluctuates more. By comparing the difference between the two, the change of the signal can be analyzed to determine the appropriate filter coefficient.
[0111] Optionally, a preset filter factor P may be obtained. 1 , P 2 and P 3 , P 1 , P 2 and P 3 are all constants, according to the formula:
[0112] k fast =1-(P 1 / (P 1 +P 2 )); Determine the filter coefficient k of the fast filter fast ;
[0113] According to the formula: k slow =1-(P 3 *P 1 / (P 3 *P 1 +P 2 )); Determine the filter coefficient k of the slow filter slow .
[0114] Step S108, filtering the centroid acceleration data using a slow filter to obtain second filtered acceleration data.
[0115] Assume a raw (t) represents the center of mass acceleration data, kfast represents the filter coefficient of the fast filter, k slow Represents the filter coefficient of the slow filter, a fast (t) represents the first filtered acceleration data calculated at the previous moment, a slow (t) represents the second filtered acceleration data calculated at the previous moment; it can be calculated according to the formula: fast (t+1)=a fast (t)+k fast *(a raw (t)-a fast (t));
[0116] Get the first filtered acceleration data a fast (t+1);
[0117] According to the formula: a slow (t+1)=a slow (t)+k slow *(a raw (t)-a slow (t));
[0118] Get the second filtered acceleration data a slow (t+1).
[0119] Step S110: determining a filter scale factor corresponding to a difference between the first filtered acceleration data and the second filtered acceleration data based on a pre-established mapping relationship between the filter data difference and the filter scale factor.
[0120] In the embodiment of the present application, a mapping relationship between a filter data difference and a filter scale factor can be established in advance through experience, where the filter data difference is the difference between the filter result of the fast filter and the filter result of the slow filter. According to the mapping relationship, a filter scale factor corresponding to the difference between the first filtered acceleration data and the second filtered acceleration data can be obtained.
[0121] Step S112: weighting the filter coefficients of the fast filter and the slow filter according to the filter scale factor to obtain the target filter coefficients.
[0122] Assume k rab (t+1) represents the filter scaling factor, k fast represents the filter coefficient of the fast filter, k slow represents the filter coefficient of the slow filter, according to the following formula:
[0123] k self (t+1)=k arb (t+1)*k slow +(1-k arb(t+1))*k fast ;
[0124] K fast and k slow Perform weighted processing to obtain the target filter coefficient k self ;
[0125] Among them, the filter data difference and the filter scale factor k rab Negatively correlated.
[0126] In k rab (t+1) as k slow In the case of weights, the filter data difference and the filter scale factor k rab On the contrary, when k rab (t+1) as k fast In the case of weights, the filter data difference and the filter scale factor k rab Positively correlated.
[0127] Step S114, using the target filter coefficient as the filter coefficient of a first-order low-pass filter, and using the first-order low-pass filter to filter the centroid acceleration data to obtain target filtered acceleration data.
[0128] Assume a raw (t) represents the acceleration data of the center of mass, a self (t) represents the target filtered acceleration data at the previous moment, k self (t+1) represents the target filter coefficient;
[0129] According to the formula: a self (t+1)=a self (t)+k self (t+1)*(a raw (t)-a self (t));
[0130] Determine the target filtered acceleration data a self (t+1).
[0131] The inertial measurement unit data processing method of the embodiment of the present application extracts acceleration data after calibrating the IMU sensor data, and converts the acceleration data into the center of mass acceleration data at the center of mass of the vehicle. The center of mass acceleration data is filtered using a fast filter and a slow filter respectively to obtain a first filtered acceleration data and a second filtered acceleration data. The filter coefficient of the fast filter is greater than the filter coefficient of the slow filter. Therefore, the filtering of the slow filter is relatively gentle, and the fluctuation of the fast filter is large. By comparing the difference between the two, the speed of signal change can be analyzed, so as to select a suitable filter proportional factor, and then calculate a suitable target filter coefficient. By dynamically adjusting the filter coefficient, the filtering effect can be adjusted in real time according to the change of the signal, so that the filter is more adaptable to different signal characteristics. The stability and sensitivity of the filter can be balanced on different time scales. For example, when the signal changes rapidly, the filter coefficient can be increased to improve the sensitivity; when the signal is relatively stable, the filter coefficient can be reduced to enhance stability. The first-order low-pass filter has the disadvantage of phase lag. Dynamic adjustment of the filter coefficient can reduce this lag to a certain extent, making the filtering result closer to the actual signal. This can ensure that the system maintains stable performance under different working conditions and avoid system instability or performance degradation caused by improper filter coefficients.
[0132] See also Figure 2 , Figure 2 This is another flow chart of the inertial measurement unit data processing method in the embodiment of the present application, which may include the following steps:
[0133] Step S202, acquiring inertial measurement unit IMU sensor data in real time, and calibrating the IMU sensor data using reference data to obtain calibrated IMU sensor data.
[0134] Step S204, extracting acceleration data from the calibration IMU sensor data, and converting the acceleration data into center of mass acceleration data at the center of mass of the vehicle.
[0135] Step S206, based on the roll angle of the vehicle, detecting whether the vehicle is in a violent motion state.
[0136] When the vehicle is in a more intense motion state (e.g., a larger roll angle), the vehicle roll will cause a larger error in the IMU sensor data. Therefore, before filtering the center of mass acceleration data, the center of mass acceleration data may be compensated for the roll angle to improve the accuracy of the center of mass acceleration data. If the vehicle is in an intense motion state, execute step S208. If the vehicle is not in an intense motion state, execute step S209. Figure 1 The method shown is executed.
[0137] Step S208, based on the roll angle, compensating the center-of-mass acceleration data at the center of mass of the vehicle to obtain compensated acceleration data.
[0138] Assume that β represents the roll angle of the vehicle, a cen Represents the center of mass acceleration data at the center of mass of the vehicle; a mapping relationship between the roll angle and the roll angle compensation coefficient can be established in advance, and based on the mapping relationship, the roll angle compensation coefficient k corresponding to the roll angle β is determined β ;
[0139] According to the formula: a y_cor =a cen *(1-k β );
[0140] Determine the compensation acceleration data a y_cor .
[0141] Step S210: Filter the compensated acceleration data using a fast filter to obtain first filtered acceleration data.
[0142] Step S212, using a slow filter to filter the compensated acceleration data to obtain second filtered acceleration data; wherein the filter coefficient of the fast filter is greater than the filter coefficient of the slow filter.
[0143] Step S214: determining a filter scale factor corresponding to a difference between the first filtered acceleration data and the second filtered acceleration data based on a pre-established mapping relationship between the filter data difference and the filter scale factor.
[0144] Step S216, weighting the filter coefficients of the fast filter and the slow filter according to the filter scale factor to obtain the target filter coefficients.
[0145] Step S218, using the target filter coefficient as the filter coefficient of a first-order low-pass filter, and using the first-order low-pass filter to filter the centroid acceleration data to obtain target filtered acceleration data.
[0146] It should be noted that Figure 2 In the embodiment Figure 1 For the same parts as the embodiments, please refer to Figure 1 The description in the embodiments is sufficient and will not be repeated here.
[0147] The inertial measurement unit data processing method of the embodiment of the present application performs roll angle compensation processing when the vehicle has a large roll angle, taking into account that the lateral acceleration data measured by the IMU will have a certain degree of deviation due to the influence of the vehicle suspension, so as to improve the accuracy of the acceleration data and thereby improve the control effect of related functions in the vehicle braking control system.
[0148] It should be noted that although the steps of the method in the present application are described in a specific order in the drawings, this does not require or imply that the steps must be performed in this specific order, or that all the steps shown must be performed to achieve the desired results. Additionally or alternatively, some steps may be omitted, multiple steps may be combined into one step, and / or one step may be decomposed into multiple steps, etc.
[0149] Corresponding to the above method embodiment, the present application embodiment also provides an inertial measurement unit data processing device, see Figure 3 , the inertial measurement unit data processing device 300 includes:
[0150] An IMU sensor data acquisition module 302 is used to acquire inertial measurement unit IMU sensor data in real time;
[0151] An IMU sensor data calibration module 304 is used to calibrate the IMU sensor data using the reference data to obtain calibrated IMU sensor data;
[0152] An acceleration data conversion module 306, for extracting acceleration data from the calibration IMU sensor data and converting the acceleration data into center of mass acceleration data at the center of mass of the vehicle;
[0153] A fast filtering module 308, configured to filter the centroid acceleration data using a fast filter to obtain first filtered acceleration data;
[0154] The slow filtering module 310 is used to filter the centroid acceleration data using a slow filter to obtain second filtered acceleration data; wherein the filter coefficient of the fast filter is greater than the filter coefficient of the slow filter;
[0155] A filter scale factor determination module 312, configured to determine a filter scale factor corresponding to a difference between the first filtered acceleration data and the second filtered acceleration data based on a pre-established mapping relationship between a filter data difference and a filter scale factor;
[0156] A target filter coefficient determination module 314 is used to perform weighted processing on the filter coefficients of the fast filter and the slow filter according to the filter scale factor to obtain the target filter coefficients;
[0157] The first-order low-pass filter module 316 is used to use the target filter coefficient as the filter coefficient of the first-order low-pass filter, and use the first-order low-pass filter to filter the centroid acceleration data to obtain target filtered acceleration data.
[0158] Optionally, the inertial measurement unit data processing device 300 further includes:
[0159] A state detection module is used to detect whether the vehicle is in a violent motion state based on the vehicle's roll angle;
[0160] The acceleration data compensation module is used to compensate the center of mass acceleration data at the center of mass of the vehicle based on the roll angle to obtain compensated acceleration data if the state detection module determines that the vehicle is in a violent motion state;
[0161] The fast filtering module 308 is specifically used to filter the compensated acceleration data using a fast filter to obtain first filtered acceleration data;
[0162] The slow filtering module 310 is specifically configured to filter the compensated acceleration data using a slow filter to obtain second filtered acceleration data.
[0163] Alternatively, let β represent the roll angle of the vehicle, a cen represents the mass center acceleration data at the mass center of the vehicle; the acceleration data compensation module is specifically used to determine the roll angle compensation coefficient k corresponding to the roll angle β based on the pre-established mapping relationship between the roll angle and the roll angle compensation coefficient β ;as well as,
[0164] According to the formula: a y_cor =a cen *(1-k β );Determine the compensation acceleration data a y_cor .
[0165] Alternatively, assuming a mea Represents the acceleration data at the IMU installation location in the vehicle, L x Indicates the longitudinal distance between the IMU installation position and the vehicle's center of mass, L y represents the lateral distance between the IMU installation position and the vehicle's center of mass, Yrs represents the vehicle's yaw rate, and D Yrs represents the yaw angular acceleration;
[0166] The acceleration data conversion module is specifically used according to the formula:
[0167] a cen =a mea -L x *D Yrs +L y *Yrs 2 ; Determine the center of mass acceleration data a at the center of mass of the vehicle cen .
[0168] Alternatively, assume that k rab (t+1) represents the filter scaling factor, k fast represents the filter coefficient of the fast filter, k slowrepresents the filter coefficient of the slow filter, and the target filter coefficient determination module 314 is specifically used to determine the target filter coefficient according to the following formula:
[0169] k self (t+1)=k arb (t+1)*k slow +(1-k arb (t+1))*k fast ;
[0170] K fast and k slow Perform weighted processing to obtain the target filter coefficient k self ;
[0171] Among them, the filter data difference and the filter scale factor k rab Negatively correlated.
[0172] Optionally, the inertial measurement unit data processing device 300 further includes:
[0173] The filter factor acquisition module is used to obtain the preset filter factor P 1 , P 2 and P 3 ;
[0174] The filter coefficient determination module of the fast filter is used to determine the filter coefficient according to the formula:
[0175] k fast =1-(P 1 / (P 1 +P 2 )); Determine the filter coefficient k of the fast filter fast ;
[0176] The filter coefficient determination module of the slow filter is used to determine the filter coefficient according to the formula:
[0177] k slow =1-(P 3 *P 1 / (P 3 *P 1 +P 2 )); Determine the filter coefficient k of the slow filter slow .
[0178] Alternatively, assuming a raw (t) represents the center of mass acceleration data, k fast represents the filter coefficient of the fast filter, k slow Represents the filter coefficient of the slow filter, a fast (t) represents the first filtered acceleration data calculated at the previous moment, a slow (t) represents the second filtered acceleration data calculated at the previous moment;
[0179] The fast filtering module 308 is specifically used according to the formula:
[0180] a fast (t+1)=a fast (t)+k fast *(a raw (t)-a fast (t));
[0181] Get the first filtered acceleration data a fast (t+1);
[0182] The slow filtering module 310 is specifically used according to the formula:
[0183] a slow (t+1)=a slow (t)+k slow *(a raw (t)-a slow (t));
[0184] Get the second filtered acceleration data a slow (t+1).
[0185] Alternatively, assuming a raw (t) represents the acceleration data of the center of mass, a self (t) represents the target filtered acceleration data at the previous moment, k self (t+1) represents the target filter coefficient;
[0186] The first-order low-pass filter module 316 is used to use the target filter coefficient as the filter coefficient of the first-order low-pass filter and according to the formula: self (t+1)=a self (t)+k self (t+1)*(a raw (t)-a self (t));
[0187] Determine the target filtered acceleration data a self (t+1).
[0188] The specific details of each module or unit in the above device have been described in detail in the corresponding method, so they will not be repeated here.
[0189] It should be noted that, although several modules or units of the equipment for action execution are mentioned in the above detailed description, this division is not mandatory. In fact, according to the embodiments of the present application, the features and functions of two or more modules or units described above can be embodied in one module or unit. On the contrary, the features and functions of one module or unit described above can be further divided into being embodied by multiple modules or units.
[0190] The present application also provides an electronic device, see Figure 4 , Figure 4 A schematic diagram of the structure of an electronic device in an embodiment of the present application, comprising: a processor 401, a communication interface 402, a memory 403 and a communication bus 404, wherein the processor 401, the communication interface 402, and the memory 403 communicate with each other through the communication bus 404;
[0191] Memory 403, used for storing computer programs;
[0192] The processor 401 is used to implement the above-mentioned inertial measurement unit data processing method when executing the program stored in the memory 403.
[0193] It should be noted that the communication bus 404 mentioned in the above electronic device can be a PCI (Peripheral Component Interconnect) bus or an EISA (Extended Industry Standard Architecture) bus. The communication bus 404 can be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Figure 4 Only one thick line is used in the diagram, but this does not mean that there is only one bus or only one type of bus.
[0194] The communication interface 402 is used for communication between the electronic device and other devices.
[0195] The memory 403 may include a RAM (Random Access Memory), or may include a non-volatile memory, such as at least one disk memory. Optionally, the memory 403 may also be at least one storage device located away from the aforementioned processor.
[0196] The above-mentioned processor 401 can be a general-purpose processor, including: CPU (Central Processing Unit), NP (Network Processor), etc.; it can also be DSP (Digital Signal Processing), ASIC (Application Specific Integrated Circuit), FPGA (Field-Programmable Gate Array) or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components.
[0197] An embodiment of the present application further provides a computer-readable storage medium having a computer program stored thereon, and when the computer program is executed by a processor, the above-mentioned inertial measurement unit data processing method is implemented.
[0198] It should be noted that the computer-readable storage medium shown in the present application may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples of computer-readable storage media may include, but are not limited to: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory, a read-only memory, an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In the present application, a computer-readable storage medium may be any tangible medium containing or storing a program that can be used by or in combination with an instruction execution system, device or device. The program code contained on the computer-readable storage medium may be transmitted using any appropriate medium, including but not limited to: wireless, wire, optical cable, radio frequency, etc., or any suitable combination of the above.
[0199] An embodiment of the present application further provides a computer program product. When the computer program product is run on a computer, the computer is enabled to execute the above-mentioned inertial measurement unit data processing method.
[0200] It should be noted that, in this article, relational terms such as "first" and "second" are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include", "comprise" or any other variants thereof are intended to cover non-exclusive inclusion, so that a process, method, article or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, article or device. In the absence of further restrictions, the elements defined by the sentence "comprise a ..." do not exclude the existence of other identical elements in the process, method, article or device including the elements.
[0201] The above description is only a specific implementation of the present application, so that those skilled in the art can understand or implement the present application. Various modifications to these embodiments will be apparent to those skilled in the art, and the general principles defined herein can be implemented in other embodiments without departing from the spirit or scope of the present application. Therefore, the present application will not be limited to the embodiments described herein, but will conform to the widest scope consistent with the principles and novel features disclosed herein.
Claims
1. A method for processing inertial measurement unit data, characterized in that: The method comprises: Acquire inertial measurement unit (IMU) sensor data in real time, and calibrate the IMU sensor data using reference data to obtain calibrated IMU sensor data; Extracting acceleration data from the calibration IMU sensor data, and converting the acceleration data into center-of-mass acceleration data at the center of mass of the vehicle; Using a fast filter to filter the centroid acceleration data to obtain first filtered acceleration data; Filtering the centroid acceleration data using a slow filter to obtain second filtered acceleration data; wherein the filter coefficient of the fast filter is greater than the filter coefficient of the slow filter; Determine the filter scale factor corresponding to the difference between the first filtered acceleration data and the second filtered acceleration data based on a pre-established mapping relationship between the filter data difference and the filter scale factor; According to the filter scale factor, weighting processing is performed on the filter coefficient of the fast filter and the filter coefficient of the slow filter to obtain a target filter coefficient; The target filter coefficient is used as the filter coefficient of a first-order low-pass filter, and the center-of-mass acceleration data is filtered using the first-order low-pass filter to obtain target filtered acceleration data.
2. The method according to claim 1, characterized in that After extracting acceleration data from the calibration IMU sensor data, the method further comprises: Based on the vehicle's roll angle, detect whether the vehicle is in a state of violent movement; If the vehicle is in a violent motion state, based on the roll angle, the center of mass acceleration data at the center of mass of the vehicle is compensated to obtain compensated acceleration data; The filtering process of the centroid acceleration data by using a fast filter specifically includes: Using a fast filter to filter the compensated acceleration data; The filtering process of the centroid acceleration data by using a slow filter specifically includes: The compensated acceleration data is filtered using a slow filter.
3. The method according to claim 2, characterized in that The method of compensating the center of mass acceleration data at the center of mass of the vehicle based on the roll angle to obtain compensated acceleration data includes: Assume that β represents the roll angle of the vehicle, a cen represents the center of mass acceleration data at the center of mass of the vehicle; Based on the pre-established mapping relationship between the roll angle and the roll angle compensation coefficient, the roll angle compensation coefficient k corresponding to the roll angle β is determined. β ; According to the formula: a y_cor =a cen *(1-k β ); Determine the compensation acceleration data a y_cor .
4. The method according to claim 1, characterized in that: The step of converting the acceleration data into center-of-mass acceleration data at the center of mass of the vehicle comprises: Assume a mea Represents the acceleration data at the IMU installation location in the vehicle, L x Indicates the longitudinal distance between the IMU installation position and the vehicle's center of mass, L y represents the lateral distance between the IMU installation position and the vehicle's center of mass, Yrs represents the vehicle's yaw rate, and D Yrs represents the yaw angular acceleration; According to the formula: a cen =a mea -L x *D Yrs +L y *Yrs 2 ; Determine the center of mass acceleration data a at the center of mass of the vehicle cen .
5. The method according to claim 1, characterized in that The step of performing weighted processing on the filter coefficients of the fast filter and the slow filter according to the filter scale factor to obtain the target filter coefficients includes: Assume k rab (t+1) represents the filter scaling factor, k fast represents the filter coefficient of the fast filter, k slow represents the filter coefficient of the slow filter, according to the following formula: k self (t+1)=k arb (t+1)*k slow +(1-k arb (t+1))*k fast ; K fast and k slow Perform weighted processing to obtain the target filter coefficient k self ; Among them, the filter data difference and the filter scale factor k rab Negatively correlated.
6. The method according to claim 1, characterized in that Before filtering the centroid acceleration data using a fast filter, the method further includes: Get the preset filter factors P1, P2 and P3 according to the formula: k fast =1-(P1 / (P1+P2)); Determine the filter coefficient k of the fast filter fast ; According to the formula: k slow =1-(P3*P1 / (P3*P1+P2)); Determine the filter coefficient k of the slow filter slow .
7. The method according to claim 1, characterized in that The filtering process of the centroid acceleration data by using a fast filter to obtain first filtered acceleration data includes: Assume a raw (t) represents the center of mass acceleration data, k fast represents the filter coefficient of the fast filter, k slow Represents the filter coefficient of the slow filter, a fast (t) represents the first filtered acceleration data calculated at the previous moment, a slow (t) represents the second filtered acceleration data calculated at the previous moment; According to the formula: a fast (t+1)=a fast (t)+k fast *(a raw (t)-a fast (t)); Get the first filtered acceleration data a fast (t+1); The filtering process of the centroid acceleration data by using a slow filter to obtain second filtered acceleration data includes: According to the formula: a slow (t+1)=a slow (t)+k slow *(a raw (t)-a slow (t)); Get the second filtered acceleration data a slow (t+1).
8. The method according to claim 1, characterized in that: The filtering process of the centroid acceleration data by using the first-order low-pass filter to obtain target filtered acceleration data includes: Assume a raw (t) represents the center of mass acceleration data, a self (t) represents the target filtered acceleration data at the previous moment, k self (t+1) represents the target filter coefficient; According to the formula: a self (t+1)=a self (t)+k self (t+1)*(a raw (t)-a self (t)); Determine the target filtered acceleration data a self (t+1).
9. An inertial measurement unit data processing device, characterized in that: The device comprises: IMU sensor data acquisition module, used to acquire inertial measurement unit IMU sensor data in real time; An IMU sensor data calibration module, used to calibrate the IMU sensor data using reference data to obtain calibrated IMU sensor data; An acceleration data conversion module, used to extract acceleration data from the calibration IMU sensor data, and convert the acceleration data into center of mass acceleration data at the center of mass of the vehicle; A fast filtering module, used for filtering the centroid acceleration data using a fast filter to obtain first filtered acceleration data; A slow filtering module, used for filtering the centroid acceleration data using a slow filter to obtain second filtered acceleration data; wherein the filtering coefficient of the fast filter is greater than the filtering coefficient of the slow filter; A filter scale factor determination module, configured to determine a filter scale factor corresponding to a difference between the first filtered acceleration data and the second filtered acceleration data based on a pre-established mapping relationship between a filter data difference and a filter scale factor; A target filter coefficient determination module, used for performing weighted processing on the filter coefficient of the fast filter and the filter coefficient of the slow filter according to the filter scale factor to obtain a target filter coefficient; The first-order low-pass filter module is used to use the target filter coefficient as the filter coefficient of the first-order low-pass filter, and use the first-order low-pass filter to filter the center of mass acceleration data to obtain target filtered acceleration data.
10. An electronic device, characterized in that: include: A processor, wherein the processor is used to execute a computer program stored in a memory, wherein the computer program, when executed by the processor, implements the method according to any one of claims 1 to 8.
