Joint estimation method and device for centroid position of electrically driven vehicle
Through the combined method of H infinite-extended Kalman filter, the accuracy problem of center of mass position measurement of electric vehicles is solved, the accurate estimation of center of mass position is achieved, and the accuracy of dynamic control and the safety of the car is improved.
Patent Information
- Application Number
- CN202411062111.5
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-05
- Publication Date
- 2024-11-12
AI Technical Summary
The prior art is difficult to accurately measure the centroid position of electric vehicles, especially when passenger and load distribution changes, affecting the accuracy of dynamic models.
Using a joint method of H infinite state filter and extended Kalman filter, a double-layer estimation architecture is constructed based on the vehicle dynamic model through vehicle driving information and state measurement information.
Accurate determination of the center of mass position of electric vehicles is achieved, the accuracy of energy management and dynamic control is improved, and the safety and reliability of the car is ensured.
Smart Images

Figure CN118940412A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of vehicle dynamics control, and in particular to a method, device, computer equipment, computer-readable storage medium and computer program product for jointly estimating the center of mass position of an electric drive vehicle. Background Art
[0002] Nowadays, hybrid and electric vehicles are increasingly being advocated as an important part of the technology needed to reduce CO2 emissions and energy waste. Therefore, energy optimization of electric vehicles has become a hot topic of research, and many scholars have recently studied energy management strategies and brake energy recovery. At the same time, many active control strategies have been developed to improve energy efficiency, such as active front wheel steering, electronic stability program and traction control. Most of the above strategies require accurate acquisition of the center of mass position to establish the dynamic model. In common cases, the center of mass position is provided in advance by the manufacturer and the load distribution has been determined. Considering the obvious changes in passenger and / or load distribution in electric vehicles, it is still a challenge to directly and accurately measure the center of mass position.
[0003] Therefore, there is an urgent need for a joint estimation method of the center of mass position of an electric vehicle that can accurately determine the center of mass position. Summary of the invention
[0004] Based on this, it is necessary to provide a method, device, computer equipment, computer-readable storage medium and computer program product for jointly estimating the center of mass position of an electric vehicle that can accurately determine the center of mass position in order to address the above technical problems.
[0005] In a first aspect, the present application provides a method for jointly estimating the center of mass position of an electric vehicle, comprising:
[0006] Acquiring vehicle driving information and first vehicle state measurement information of a target vehicle;
[0007] Inputting the first vehicle state measurement information into an H-infinity state filter of the target vehicle to obtain first vehicle state estimation information of the target vehicle;
[0008] The vehicle driving information and the first vehicle state estimation information are input into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle; the H-infinity state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle.
[0009] In one embodiment, the step of inputting the first vehicle state measurement information into an H-infinity state filter of the target vehicle to obtain the first vehicle state estimation information of the target vehicle includes:
[0010] Inputting the first vehicle state measurement information into an H-infinity state filter of the target vehicle;
[0011] The first vehicle state estimation information of the target vehicle is determined by the H infinite state filter according to the first vehicle state measurement information, the first vehicle state estimation information of the previous time step, and the first gain matrix of the H infinite state filter of the previous time step.
[0012] In one embodiment, the method further comprises:
[0013] Determine, by the H infinite state filter, a first error covariance matrix of the current time step of the H infinite state filter according to a first system noise covariance matrix, a first measurement noise covariance matrix and a first state covariance matrix of the current time step of the H infinite state filter, and a first error covariance matrix of a previous time step;
[0014] The first gain matrix of the H infinite state filter at the current time step is determined by the H infinite state filter according to the first error covariance matrix of the current time step and the first measurement noise covariance matrix and the first state covariance matrix of the next time step of the H infinite state filter stored in advance.
[0015] In one embodiment, inputting the vehicle driving information and the first vehicle state estimation information into an extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle includes:
[0016] inputting the vehicle driving information and the first vehicle state estimation information into an extended Kalman filter of the target vehicle;
[0017] Determine, by means of the extended Kalman filter, a priori estimation of the center of mass position state of the target vehicle at the current time step according to the center of mass position information of the target vehicle at the previous time step;
[0018] Determining, by the extended Kalman filter, an error covariance prior estimate of the current time step of the extended Kalman filter according to a second error covariance matrix of a previous time step of the extended Kalman filter and a second system noise covariance matrix;
[0019] Determining, by the extended Kalman filter, a second gain matrix of the extended Kalman filter at the current time step according to the error covariance a priori estimate of the extended Kalman filter at the current time step and the second measurement noise covariance matrix, and the vehicle driving information;
[0020] The extended Kalman filter is used to determine the center of mass position information of the target vehicle based on the vehicle driving information, the first vehicle state estimation information, the second gain matrix of the current time step, and the prior estimate of the center of mass position state of the current time step.
[0021] In one embodiment, the vehicle dynamics model is a three-degree-of-freedom longitudinal dynamics model, and the method further includes:
[0022] Establish a single-vehicle longitudinal dynamics model of the target vehicle;
[0023] Establishing a front wheel model and a rear wheel model of the target vehicle;
[0024] The single-vehicle longitudinal dynamics model, the front wheel model and the rear wheel model constitute a three-degree-of-freedom longitudinal dynamics model of the target vehicle.
[0025] In one embodiment, the vehicle dynamics model is established based on the road slope information of the road where the target vehicle is located, and the method further includes:
[0026] Acquire vehicle motion information and second vehicle state measurement information of the target vehicle;
[0027] Inputting the vehicle motion information and the second vehicle state measurement information into a road gradient estimator of the road where the target vehicle is located; the road gradient estimator is established based on a longitudinal acceleration model and an H-infinity filter;
[0028] The road slope information of the road where the target vehicle is located is determined by the road slope estimator based on the vehicle motion information, the second vehicle state measurement information, the second vehicle state estimation information of the target vehicle at the previous time step, and the third system noise covariance matrix and the third measurement noise covariance matrix of the road slope estimator at the previous time step.
[0029] In a second aspect, the present application also provides a device for jointly estimating the center of mass position of an electric vehicle, comprising:
[0030] A first acquisition module, used to acquire vehicle driving information and first vehicle state measurement information of a target vehicle;
[0031] A first estimation module, configured to input the first vehicle state measurement information into an H-infinity state filter of the target vehicle to obtain first vehicle state estimation information of the target vehicle;
[0032] The second estimation module is used to input the vehicle driving information and the first vehicle state estimation information into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle; the H-infinity state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle.
[0033] In a third aspect, the present application further provides a computer device, including a memory and a processor, wherein the memory stores a computer program, and the processor implements the steps described in the first aspect when executing the computer program.
[0034] In a fourth aspect, the present application further provides a computer-readable storage medium having a computer program stored thereon, wherein the computer program, when executed by a processor, implements the steps described in the first aspect above.
[0035] In a fifth aspect, the present application further provides a computer program product, comprising a computer program, which implements the steps described in the first aspect when executed by a processor.
[0036] The above-mentioned method, device, computer equipment, computer-readable storage medium and computer program product for jointly estimating the center of mass position of an electric-drive vehicle obtain vehicle driving information and first vehicle state measurement information of a target vehicle; input the first vehicle state measurement information into the H-infinity state filter of the target vehicle to obtain first vehicle state estimation information of the target vehicle; input the vehicle driving information and the first vehicle state estimation information into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle; the H-infinity state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle. In this way, the H-infinity state filter and the extended Kalman filter are respectively constructed based on the vehicle dynamics model of the target vehicle. The H-infinity state filter performs filtering processing on the state by minimizing the influence of noise of unknown statistical data to ensure that the vehicle state can be accurately estimated. Another extended Kalman filter uses the state derived from the previous filter to effectively estimate the center of mass position of the vehicle. State filtering and parameter estimation are divided into a two-layer estimation architecture, and the H-infinity-Extended Kalman Filter (H-infinity-Extended Kalman Filter) is combined to obtain the center of mass position of the vehicle. ∞ -EKF), taking into account the noise uncertainty, is more in line with the actual situation and can achieve accurate determination of the center of mass position. BRIEF DESCRIPTION OF THE DRAWINGS
[0037] In order to more clearly illustrate the technical solutions in the embodiments of the present application or related technologies, the drawings required for use in the embodiments of the present application or related technical descriptions will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.
[0038] FIG1 is a schematic diagram of a flow chart of a method for jointly estimating the center of mass position of an electric vehicle in one embodiment;
[0039] 2 is a flow chart showing the steps of inputting first vehicle state measurement information into an H-infinity state filter of a target vehicle to obtain first vehicle state estimation information of the target vehicle in one embodiment;
[0040] FIG3 is a schematic flow chart of a step of updating a first gain matrix in one embodiment;
[0041] 4 is a flow chart showing the steps of inputting vehicle driving information and first vehicle state estimation information into an extended Kalman filter of a target vehicle to obtain center of mass position information of the target vehicle in one embodiment;
[0042] FIG5 is a schematic diagram of a double-layer architecture in one embodiment;
[0043] FIG6 is a schematic flow chart of a process of constructing a vehicle dynamics model in one embodiment;
[0044] FIG7 is a schematic diagram of a simplified longitudinal model of a target vehicle in one embodiment;
[0045] FIG8 is a schematic diagram of a single wheel model in one embodiment;
[0046] FIG9 is a schematic diagram of a process for determining the road slope information of the road where the target vehicle is located in one embodiment;
[0047] FIG10 is a schematic diagram of the architecture of a road slope estimator in one embodiment;
[0048] FIG11 is a structural block diagram of a device for jointly estimating the center of mass position of an electric vehicle in one embodiment;
[0049] FIG. 12 is a diagram showing the internal structure of a computer device in one embodiment. DETAILED DESCRIPTION
[0050] In order to make the purpose, technical solution and advantages of the present application more clearly understood, the present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present application and are not used to limit the present application.
[0051] In one embodiment, as shown in FIG1 , a method for jointly estimating the center of mass position of an electric vehicle is provided. This embodiment uses the method applied to a terminal as an example for illustration. It is understandable that the method can also be applied to a server, and can also be applied to a system including a terminal and a server, and is implemented through the interaction between the terminal and the server. Among them, the terminal can be, but is not limited to, various personal computers, laptops, smart phones, tablet computers, Internet of Things devices and portable wearable devices. The Internet of Things devices can be smart speakers, smart TVs, smart air conditioners, smart car-mounted devices, projection devices, etc. Portable wearable devices can be smart watches, smart bracelets, head-mounted devices, etc. The head-mounted device can be a virtual reality (VR) device, an augmented reality (AR) device, smart glasses, etc. The server can be an independent physical server, or a server cluster or distributed system composed of multiple physical servers, or a cloud server that provides cloud computing services. In this embodiment, the method includes the following steps:
[0052] Step 101: Acquire vehicle driving information and first vehicle state measurement information of a target vehicle.
[0053] In an embodiment of the present application, the terminal measures the vehicle driving information and the first vehicle state measurement information of the target vehicle through a sensor. The target vehicle is a vehicle whose center of mass position is to be determined, which is an electric drive vehicle, a hybrid vehicle, or an electric vehicle. For example, the target vehicle is a distributed electric drive vehicle, that is, a vehicle in which each wheel is equipped with a separate motor for driving. The vehicle driving information may include the front wheel drive torque and the rear wheel drive torque of the target vehicle. The first vehicle state measurement information is used to indicate the operating state of the target vehicle, and may include the longitudinal speed, the front wheel angular velocity, and the rear wheel angular velocity of the target vehicle.
[0054] Step 102: input the first vehicle state measurement information into the H-infinity state filter of the target vehicle to obtain the first vehicle state estimation information of the target vehicle.
[0055] In the embodiment of the present application, H is infinite (H ∞ ) The state filter is used to filter the vehicle state with noise of unknown statistical data to ensure that the vehicle state can be accurately estimated. The first vehicle state measurement information is the vehicle state information with noise of unknown statistical data obtained by measurement. The first vehicle state estimation information is the estimated value of the vehicle state information with noise of unknown statistical data eliminated. The H infinite state filter may include three one-dimensional H infinite state sub-filters. The three one-dimensional H infinite state sub-filters may be executed synchronously to respectively estimate the longitudinal velocity, front wheel angular velocity and rear wheel angular velocity of the target vehicle.
[0056] Step 103: input the vehicle driving information and the first vehicle state estimation information into an extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle.
[0057] Among them, the H infinite state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle.
[0058] In the embodiment of the present application, the center of mass position information is used to indicate the center of mass position of the target vehicle, and may include the center of mass height of the target vehicle, the ratio of the longitudinal distance between the rear axle and the center of mass to the wheelbase, and the tire-road slip slope determined by the front / rear tire characteristics and the road surface characteristics for the front wheels. The extended Kalman filter (Extended KalmanFilter, EKF) is used to estimate the center of mass position of the target vehicle, and may be a three-dimensional extended Kalman filter, which is used to simultaneously estimate the center of mass height of the target vehicle, the ratio of the longitudinal distance between the rear axle and the center of mass to the wheelbase, and the tire-road slip slope determined by the front / rear tire characteristics and the road surface characteristics for the front wheels.
[0059] In the above-mentioned method for jointly estimating the center of mass position of an electric-drive vehicle, vehicle driving information and first vehicle state measurement information of a target vehicle are obtained; the first vehicle state measurement information is input into the H-infinity state filter of the target vehicle to obtain the first vehicle state estimation information of the target vehicle; the vehicle driving information and the first vehicle state estimation information are input into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle; the H-infinity state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle. In this way, the H-infinity state filter and the extended Kalman filter are respectively constructed based on the vehicle dynamics model of the target vehicle. The H-infinity state filter performs filtering processing on the state by minimizing the influence of noise of unknown statistical data to ensure that the vehicle state can be accurately estimated. Another extended Kalman filter uses the state derived from the previous filter to effectively estimate the center of mass position of the vehicle. The state filtering and parameter estimation are divided into a two-layer estimation architecture, and the H-infinity-Extended Kalman Filter (H-infinity-Extended Kalman Filter) is combined. ∞ -EKF), taking into account the noise uncertainty, is more in line with the actual situation and can accurately determine the center of mass position. In addition, this method not only takes into account the noise uncertainty, but also does not require the known statistical characteristics of noise that affect the vehicle dynamics process but is difficult to measure, which can expand the application scope of center of mass position determination. In addition, this method accurately determines the center of mass position, which can ensure the safety and reliability of electric vehicles (EVs).
[0060] In one embodiment, the specific process of the terminal establishing the H infinite state filter of the target vehicle based on the vehicle dynamics model of the target vehicle may include the following steps: the terminal rewrites the vehicle dynamics model of the target vehicle into a discrete form, which can be expressed as:
[0061]
[0062] Where k is the current time step; u k and z k They represent the system input and measurement output respectively. The system input is the vehicle driving information, and the measurement output is the first vehicle state measurement information; x s Indicates the system status [v x ,w1,w2] T , i.e. the first vehicle state estimation information, v x is the longitudinal velocity, w1 is the front wheel angular velocity, w2 is the rear wheel angular velocity; x p Represents the parameter [h,K λ ,ζ] T , i.e., the centroid position information, h is the centroid height, K λ is the ratio of the longitudinal distance between the rear axle and the center of mass to the wheelbase, ζ is the tire-road slip slope determined by the front / rear tire characteristics and the road surface characteristics; w k and v k are process noise and measurement noise which are assumed to be independent and Gaussian. In order to calculate tire forces, accurate knowledge of the slip ratio is crucial. Therefore, the wheel speed and vehicle speed should be accurately obtained. In this process, the standard Kalman filter (KF) is widely used, and the statistical characteristics of the system noise and measurement noise are considered to be known. However, engineers usually cannot obtain the statistical characteristics of the actual vehicle noise. H-infinity filters are rarely applied to estimate the center of mass position. This method provides a new idea for vehicle parameter estimation using H-infinity filters. Each vehicle state can be observed by sensors, and the equation of each state can be described in state space form. The terminal uses state space form to describe the equation of each state, which can be expressed as:
[0063]
[0064] Among them, x s represents the system state vector, w s and v s represents the unmeasured process noise and measurement noise that affect the system state, and y represents the estimated system state, that is, the first vehicle state estimation information. Then, the terminal converts H ∞ The cost function of the filter is defined as:
[0065]
[0066] in, and other similar symbols represent weighted inner products; N is the measurement time domain; Q s , R s and S represent the system noise ws , measurement noise v s and the covariance matrix of the estimated state y, P s Represents the covariance matrix of the state estimation error, i.e., Q s , R s , S and P s They represent the first system noise covariance matrix, the first measurement noise covariance matrix, the first state covariance matrix and the first error covariance matrix of the H infinite state filter respectively. s , Q s and R s is unknown. The design goal is to find an estimate y that reduces w s , v s and x0 uncertainty, and minimize the estimation error. Under the worst conditions, H ∞ The filter can be considered as an optimal filter under severe interference conditions.
[0067] Rewriting the Kalman filter (KF) equation as the same variant of the H infinite state filter can be expressed as:
[0068]
[0069] The Kalman filter is H ∞ A special case of the filter, when h is 0, H ∞ The filter can be viewed as a Kalman filter. The above equation reveals that θS k P s k-1 Tend to make P s k and K s k-1 is larger, which increases the weight of the measurement. Compared with the Kalman filter, H ∞ The filter is more robust than the Kalman filter. It has increased tolerance to unmodeled dynamics and noise.
[0070] In one embodiment, the dynamic equation of the extended Kalman filter of the target vehicle established by the terminal based on the vehicle dynamics model of the target vehicle is defined as follows:
[0071]
[0072] Among them, w p and v p Represents the unmeasured process noise and measurement noise that affect the system state.
[0073] In an exemplary embodiment, as shown in FIG. 2 , the specific process of inputting the first vehicle state measurement information into the H-infinity state filter of the target vehicle to obtain the first vehicle state estimation information of the target vehicle includes the following steps:
[0074] Step 201: input first vehicle state measurement information into an H-infinity state filter of a target vehicle.
[0075] Step 202, determining first vehicle state estimation information of the target vehicle through an H infinite state filter according to first vehicle state measurement information, first vehicle state estimation information of a previous time step, and a first gain matrix of the H infinite state filter of a previous time step.
[0076] In the embodiment of the present application, the first gain matrix is a gain matrix of an H infinite state filter.
[0077] In one embodiment, step 202 may be expressed as: ,in, is the first vehicle state estimation information of the target vehicle, is the first vehicle state estimation information of the previous time step, is the first vehicle state measurement information, It is the first gain matrix of the H infinite state filter in the previous time step.
[0078] In one embodiment, the terminal performs initialization processing on the H infinite state filter. Specifically, for k=0, the terminal sets: , , , , .
[0079] In the above-mentioned method for jointly estimating the center of mass position of an electric drive vehicle, the first vehicle state estimation information of the target vehicle is determined by updating the filter according to the first vehicle state measurement information, the first vehicle state estimation information of the previous time step, and the first gain matrix of the H-infinity state filter of the previous time step. The H-infinity filter is rarely applied to estimate the center of mass position, which has stronger robustness than the Kalman filter, can effectively process the unmodeled dynamic parts and noise, can improve the accuracy of vehicle state estimation, and thus improve the accuracy and robustness of center of mass position determination.
[0080] In an exemplary embodiment, as shown in FIG3 , the method further includes the following steps:
[0081] Step 301, determining the first error covariance matrix of the H infinite state filter at the current time step through the H infinite state filter according to the first system noise covariance matrix, the first measurement noise covariance matrix and the first state covariance matrix of the H infinite state filter at the current time step, and the first error covariance matrix of the previous time step.
[0082] In an embodiment of the present application, the first system noise covariance matrix, the first measurement noise covariance matrix, the first state covariance matrix, and the first error covariance matrix are respectively the system noise covariance matrix, the measurement noise covariance matrix, the state covariance matrix, and the error covariance matrix of the H-infinity state filter.
[0083] In one embodiment, step 301 can be expressed as: ,in, is the first error covariance matrix of the H infinite state filter at the current time step, is the first error covariance matrix of the previous time step, , and are the first system noise covariance matrix, the first measurement noise covariance matrix and the first state covariance matrix of the current time step, respectively, Q s , R s , S and P s 0 must be symmetric and positive definite, θ represents the performance constraint specified by the user, and I is the n-order identity matrix. When choosing θ, the following conditions must be met to ensure that the previous algorithm can be successfully implemented:
[0084]
[0085] Step 302, determining the first gain matrix of the H infinite state filter at the current time step through the H infinite state filter according to the first error covariance matrix of the current time step and the first measurement noise covariance matrix and the first state covariance matrix of the next time step of the H infinite state filter stored in advance.
[0086] In an embodiment of the present application, the first system noise covariance matrix, the first measurement noise covariance matrix and the first state covariance matrix may all be preset values, or they may be individually updated and iterated by the H infinite state filter according to fixed initial values and then stored in the H infinite state filter.
[0087] In one embodiment, step 302 may be expressed as: ,in, is the first gain matrix of the H infinite state filter at the current time step, and are the first measurement noise covariance matrix and the first state covariance matrix of the H infinite state filter in the next time step, respectively.
[0088] It can be understood that the first vehicle state estimation information, the first error covariance matrix and the first gain matrix in the H-infinity state filter are updated over time.
[0089] In the above-mentioned method for jointly estimating the center of mass position of an electric drive vehicle, the first error covariance matrix of the H infinite state filter at the current time step is determined by the H infinite state filter according to the first system noise covariance matrix, the first measurement noise covariance matrix and the first state covariance matrix of the H infinite state filter at the current time step, and the first error covariance matrix of the previous time step; the first gain matrix of the H infinite state filter at the current time step is determined by the H infinite state filter according to the first error covariance matrix of the current time step and the first measurement noise covariance matrix and the first state covariance matrix of the next time step of the H infinite state filter stored in advance. In this way, the H infinite state filter continuously updates the first error covariance matrix and the first gain matrix used to determine the first vehicle state estimation information of the target vehicle over time, which is more in line with the actual situation, can ensure that the vehicle state can be accurately estimated, and thus improve the accuracy of the center of mass position determination.
[0090] In an exemplary embodiment, as shown in FIG4 , the specific process of inputting the vehicle driving information and the first vehicle state estimation information into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle includes the following steps:
[0091] Step 401 : inputting vehicle driving information and first vehicle state estimation information into an extended Kalman filter of a target vehicle.
[0092] Step 402, by using an extended Kalman filter, based on the center of mass position information of the target vehicle at the previous time step, a priori estimate of the center of mass position state of the target vehicle at the current time step is determined.
[0093] In an embodiment of the present application, the terminal uses an extended Kalman filter to use the center of mass position information of the target vehicle at the previous time step as a priori estimate of the center of mass position state of the target vehicle at the current time step.
[0094] In one embodiment, step 402 may be expressed as: ,in, is the prior estimate of the center of mass position state, is the centroid position information of the previous time step.
[0095] Step 403, determining the error covariance prior estimate of the extended Kalman filter at the current time step through the extended Kalman filter according to the second error covariance matrix of the extended Kalman filter at the previous time step and the second system noise covariance matrix.
[0096] In an embodiment of the present application, the terminal adds the second error covariance matrix of the extended Kalman filter at the previous time step and the second system noise covariance matrix through an extended Kalman filter to obtain a priori estimate of the error covariance of the extended Kalman filter at the current time step.
[0097] In one embodiment, step 403 may be expressed as: ,in, is the prior estimate of the error covariance of the extended Kalman filter at the current time step, and are the second error covariance matrix and the second system noise covariance matrix of the extended Kalman filter at the previous time step, respectively.
[0098] Step 404 , determining a second gain matrix of the extended Kalman filter at the current time step through the extended Kalman filter according to the error covariance prior estimate of the extended Kalman filter at the current time step and the second measurement noise covariance matrix, as well as the vehicle driving information.
[0099] In an embodiment of the present application, the second system noise covariance matrix, the second measurement noise covariance matrix, the second error covariance matrix, and the second gain matrix are respectively the system noise covariance matrix, the measurement noise covariance matrix, the error covariance matrix, and the gain matrix of the extended Kalman filter. The second system noise covariance matrix and the second measurement noise covariance matrix can both be preset values, or they can be stored in the extended Kalman filter after being updated and iterated separately according to a fixed initial value by the extended Kalman filter.
[0100] In one embodiment, step 404 may be expressed as: ,in, is the second gain matrix of the extended Kalman filter at the current time step, and are the error covariance prior estimate and the second measurement noise covariance matrix of the extended Kalman filter at the current time step, respectively; is the Jacobian matrix, which is the partial derivative of the function F, which represents the vehicle driving information. It can be expressed as:
[0101]
[0102] Step 405, by using an extended Kalman filter, the center of mass position information of the target vehicle is determined based on the vehicle driving information, the first vehicle state estimation information, the second gain matrix of the current time step, and the prior estimation of the center of mass position state of the current time step.
[0103] In the embodiment of the present application, step 405 can be expressed as: ,in, is the centroid position information, Indicates vehicle driving information. It is the first vehicle state estimation information.
[0104] In one embodiment, the terminal performs initialization processing on the extended Kalman filter. Specifically, for k=0, the terminal sets: , , , .
[0105] In the above-mentioned joint estimation method of the center of mass position of the electric drive vehicle, the parameters of the prior estimation of the center of mass position state and the prior estimation of the error covariance are predicted by extending the Kalman filter, and the parameters of the second gain matrix of the extended Kalman filter are updated according to the predicted parameters. Then, the center of mass position is updated according to the predicted parameters and the updated second gain matrix, which can effectively estimate the longitudinal position and height of the center of mass, thereby improving the accuracy of determining the center of mass position.
[0106] In an exemplary embodiment, the method also includes the following steps: determining, by an extended Kalman filter, a second error covariance matrix of the extended Kalman filter at the current time step based on the second gain matrix and error covariance prior estimate of the extended Kalman filter at the current time step, and vehicle driving information.
[0107] In the embodiment of the present application, the above steps can be expressed as: ,in, is the second error covariance matrix of the extended Kalman filter at the current time step. It can be understood that the second error covariance matrix and the second gain matrix in the extended Kalman filter are updated over time. In this way, the extended Kalman filter continuously updates the second error covariance matrix used to determine the center of mass position of the target vehicle over time, which is more in line with the actual situation and can ensure the accuracy of the center of mass position determination.
[0108] In one embodiment, a two-layer estimation architecture composed of an H infinite state filter and an extended Kalman filter is shown in FIG5. An input u is input to a target vehicle, and the target vehicle outputs a measurement output z. The first vehicle state measurement information obtained by measurement is a measurement output including noise. The H infinite state filter is based on the first vehicle state measurement information, the first vehicle state estimation information of the previous time step, and the first vehicle state estimation information of the previous time step. , the user-specified performance constraint θ, and the first system noise covariance matrix of the H infinite state filter at the previous time step , the first measurement noise covariance matrix , determine and output the first vehicle state estimation information of the target vehicle The extended Kalman filter includes an EKF parameter prediction module and an EKF parameter update module. The extended Kalman filter is based on the input u and the centroid position information of the previous time step. , first vehicle state estimation information , and the second system noise covariance matrix of the extended Kalman filter at the previous time step , the second measurement noise covariance matrix of the current time step , determine and output the center of mass position information of the target vehicle Among them, the EKF parameter prediction module inputs the prior estimate of the center of mass position state to the EKF parameter update module and error covariance prior estimates .
[0109] In an exemplary embodiment, as shown in FIG6 , the vehicle dynamics model is a three-degree-of-freedom longitudinal dynamics model, and the method further includes the following steps:
[0110] Step 601, establishing a single-vehicle longitudinal dynamics model of the target vehicle.
[0111] In the embodiment of the present application, the terminal establishes a single-vehicle longitudinal dynamics model of the target vehicle based on the preset modeling assumptions of the vehicle longitudinal dynamics. The modeling assumptions of the vehicle longitudinal dynamics include: (1) the vehicle is driving straight, so the model does not include yaw motion; (2) the vertical motion of the vehicle caused by the suspension is ignored; (3) the four-wheel vehicle model is simplified to a two-wheel motorcycle model; (4) the influence of air resistance and rolling resistance torque is ignored. The three-degree-of-freedom longitudinal dynamics model includes the front wheel angular velocity w1, the rear wheel angular velocity w2 and the longitudinal velocity v x .
[0112] In one embodiment, a simplified longitudinal model of the target vehicle is shown in FIG7 , and the longitudinal dynamics model of the single vehicle can be expressed as:
[0113]
[0114]
[0115] in
[0116]
[0117]
[0118] in, and are the vertical forces of the front and rear tires, a z is the vertical acceleration of the vehicle, a x represents the longitudinal acceleration of the vehicle, γ represents the equivalent acceleration, l represents the wheelbase, l r represents the longitudinal distance between the rear axle and the center of mass, h represents the height of the center of mass, represents the road slope angle of the target vehicle, CG is the center of mass of the target vehicle, l f Represents the longitudinal distance between the front axle and the center of mass.
[0119] Step 602, establishing a front wheel model and a rear wheel model of the target vehicle.
[0120] In the embodiment of the present application, considering that each wheel in an electric vehicle can be controlled independently, the terminal establishes a single wheel model for the target vehicle. The front wheel model and the rear wheel model can be the same single wheel model.
[0121] Step 603: The single-vehicle longitudinal dynamics model, the front wheel model and the rear wheel model are combined to form a three-degree-of-freedom longitudinal dynamics model of the target vehicle.
[0122] In one embodiment, the single wheel model is shown in FIG8 . The three-degree-of-freedom longitudinal dynamics model of the target vehicle can be expressed as:
[0123]
[0124] Among them, the subscript i=1,2 represents the front wheel and the rear wheel, v x represents the longitudinal velocity of the vehicle, T ti represents the driving torque of two independently controlled wheels, w i is the wheel angular velocity, r is the effective radius of the tire, and I is the moment of inertia of the wheel. g is the component of gravity parallel to the inclined ground and can be calculated as follows:
[0125]
[0126] The total longitudinal force can be expressed as:
[0127]
[0128] The terminal calculates the longitudinal force using a simple linear tire model as follows:
[0129]
[0130] Here, the expression of the longitudinal slip ratio is:
[0131]
[0132] Among them, the coefficient Defined as the tire-road slip slope determined by the front / rear tire characteristics and the road surface characteristics. The calculation of longitudinal force in the formula is only applicable to the linear tire model, and |s i |<0.03. Since the tire vertical force and road conditions are unknown, the coefficient May be identified along with other vehicle parameters.
[0133] In the above-mentioned method for jointly estimating the center of mass position of an electric-drive vehicle, a single-vehicle longitudinal dynamics model of the target vehicle is established; a front wheel model and a rear wheel model of the target vehicle are established; and the single-vehicle longitudinal dynamics model, the front wheel model and the rear wheel model are combined to form a three-degree-of-freedom longitudinal dynamics model of the target vehicle. In this way, a three-degree-of-freedom longitudinal dynamics model is performed for the target vehicle, including a vehicle longitudinal dynamics model and a tire model. Not only an accurate dynamics model is established for the target vehicle, which can improve the accuracy of the center of mass position determination, but also the characteristics of the independently controlled wheel hub torque are utilized. The estimation method only requires the longitudinal stimulation of the vehicle, avoiding other possible adverse stimulations, such as the lateral and yaw motions of the vehicle, avoiding the yaw or roll motion of the vehicle, and improving the handling stability of the vehicle. In addition, since the method adopts a three-degree-of-freedom longitudinal dynamics model, it does not require additional parameters that cannot be measured in reality, such as parameters related to the suspension and tire parameters, and has strong practicality and can expand the application scope of the center of mass position determination.
[0134] In an exemplary embodiment, as shown in FIG9 , the vehicle dynamics model is established based on the road gradient information of the road where the target vehicle is located, and the method further includes the following steps:
[0135] Step 901: Acquire vehicle motion information and second vehicle state measurement information of a target vehicle.
[0136] Step 902 : Input the vehicle motion information and the second vehicle state measurement information into a road gradient estimator of the road where the target vehicle is located.
[0137] Among them, the road slope estimator is established based on the longitudinal acceleration model and the H-infinity filter.
[0138] In the embodiment of the present application, the vehicle motion information includes longitudinal acceleration, the second vehicle state measurement information includes longitudinal velocity, and the second vehicle state estimation information includes longitudinal velocity and road slope.
[0139] In one embodiment, the road slope estimator can be expressed as:
[0140]
[0141] therefore,
[0142]
[0143] Among them, the state vector x includes the longitudinal velocity v x and road slope angle ; System input u, that is, the vehicle motion information of the target vehicle is the longitudinal acceleration a x , the system output is z, that is, the second vehicle state measurement information is v x ;w d is the part of the longitudinal dynamics model that is disturbed and not described; for the road slope, its first derivative is considered to be an independent, zero-mean, Gaussian noise v, assuming that the road slope angle changes slightly in each sampling period. d .
[0144] Step 903, through the road slope estimator, determine the road slope information of the road where the target vehicle is located based on the vehicle motion information, the second vehicle state measurement information, the second vehicle state estimation information of the target vehicle at the previous time step, and the third system noise covariance matrix and the third measurement noise covariance matrix of the road slope estimator at the previous time step.
[0145] In the embodiment of the present application, it can be understood that the internal specific operation process of the road slope estimator is similar to the internal specific operation process of the H-infinity filter, and is similar to the specific process of steps 201-202 and 301-302. The road slope information includes the road slope. The third system noise covariance matrix and the third measurement noise covariance matrix are the system noise covariance matrix and the measurement noise covariance matrix of the road slope estimator.
[0146] In one embodiment, the architecture of the road slope estimator is shown in FIG10. The terminal uses the road slope estimator to calculate the target vehicle's second vehicle state estimation information (system input u), the second vehicle state measurement information (system output z), and the target vehicle's second vehicle state estimation information at the previous time step. , another user-specified performance constraint θ, and the third system noise covariance matrix Q of the road grade estimator at the last time step k-1 and the third measurement noise covariance matrix R k-1 , determine the second vehicle state estimation information of the target vehicle at the current time step , get the second vehicle state estimation information of the current time step The road slope of the road where the target vehicle is located .
[0147] In one embodiment, as for the vertical acceleration a z , described as follows:
[0148]
[0149] in, is measured, Thus, compared with the vertical acceleration obtained by performing the second derivative of the height z, which is usually not accurate, the vertical acceleration obtained by this method is based on the accurately estimated road slope and has higher accuracy.
[0150] In the above-mentioned method for jointly estimating the center of mass position of an electric drive vehicle, the vehicle motion information and the second vehicle state measurement information of the target vehicle are obtained; the vehicle motion information and the second vehicle state measurement information are input into the road slope estimator of the road where the target vehicle is located; through the road slope estimator, the road slope information of the road where the target vehicle is located is determined according to the vehicle motion information, the second vehicle state measurement information, the second vehicle state estimation information of the target vehicle in the previous time step, and the third system noise covariance matrix and the third measurement noise covariance matrix of the road slope estimator in the previous time step. In this way, the road surface slope angle plays a vital role in calculating γ, however, it is usually impossible to measure in practice. The method uses the longitudinal acceleration model and H-infinity filter theory to estimate the road slope, which can effectively realize the estimation of the road slope and further improve the accuracy of the center of mass position determination.
[0151] It should be understood that, although the various steps in the flowcharts involved in the above-mentioned embodiments are displayed in sequence according to the indication of the arrows, these steps are not necessarily executed in sequence according to the order indicated by the arrows. Unless there is a clear explanation in this article, the execution of these steps does not have a strict order restriction, and these steps can be executed in other orders. Moreover, at least a part of the steps in the flowcharts involved in the above-mentioned embodiments can include multiple steps or multiple stages, and these steps or stages are not necessarily executed at the same time, but can be executed at different times, and the execution order of these steps or stages is not necessarily to be carried out in sequence, but can be executed in turn or alternately with other steps or at least a part of the steps or stages in other steps.
[0152] Based on the same inventive concept, the embodiment of the present application also provides an electric vehicle center of mass position joint estimation device for implementing the electric vehicle center of mass position joint estimation method involved above. The implementation scheme for solving the problem provided by the device is similar to the implementation scheme recorded in the above method, so the specific limitations in one or more electric vehicle center of mass position joint estimation device embodiments provided below can refer to the limitations of the electric vehicle center of mass position joint estimation method above, and will not be repeated here.
[0153] In an exemplary embodiment, as shown in FIG11 , a device 1100 for jointly estimating the center of mass position of an electric vehicle is provided, comprising: a first acquisition module 1110, a first estimation module 1120, and a second estimation module 1130, wherein:
[0154] A first acquisition module 1110, configured to acquire vehicle driving information and first vehicle state measurement information of a target vehicle;
[0155] A first estimation module 1120, configured to input the first vehicle state measurement information into an H-infinity state filter of the target vehicle to obtain first vehicle state estimation information of the target vehicle;
[0156] The second estimation module 1130 is used to input the vehicle driving information and the first vehicle state estimation information into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle; the H-infinity state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle.
[0157] Optionally, the first estimating module 1120 is specifically configured to:
[0158] Inputting the first vehicle state measurement information into an H-infinity state filter of the target vehicle;
[0159] The first vehicle state estimation information of the target vehicle is determined by the H infinite state filter according to the first vehicle state measurement information, the first vehicle state estimation information of the previous time step, and the first gain matrix of the H infinite state filter of the previous time step.
[0160] Optionally, the device 1100 further includes:
[0161] A first determination module is used to determine the first error covariance matrix of the H infinite state filter at the current time step through the H infinite state filter according to the first system noise covariance matrix, the first measurement noise covariance matrix and the first state covariance matrix of the H infinite state filter at the current time step, and the first error covariance matrix of the previous time step;
[0162] The second determination module is used to determine the first gain matrix of the H infinite state filter at the current time step through the H infinite state filter according to the first error covariance matrix of the current time step and the first measurement noise covariance matrix and the first state covariance matrix of the next time step of the H infinite state filter stored in advance.
[0163] Optionally, the second estimation module 1130 is specifically configured to:
[0164] inputting the vehicle driving information and the first vehicle state estimation information into an extended Kalman filter of the target vehicle;
[0165] Determine, by means of the extended Kalman filter, a priori estimation of the center of mass position state of the target vehicle at the current time step according to the center of mass position information of the target vehicle at the previous time step;
[0166] Determining, by the extended Kalman filter, an error covariance prior estimate of the current time step of the extended Kalman filter according to a second error covariance matrix of a previous time step of the extended Kalman filter and a second system noise covariance matrix;
[0167] Determining, by the extended Kalman filter, a second gain matrix of the extended Kalman filter at the current time step according to the error covariance a priori estimate of the extended Kalman filter at the current time step and the second measurement noise covariance matrix, and the vehicle driving information;
[0168] The extended Kalman filter is used to determine the center of mass position information of the target vehicle based on the vehicle driving information, the first vehicle state estimation information, the second gain matrix of the current time step, and the prior estimate of the center of mass position state of the current time step.
[0169] Optionally, the vehicle dynamics model is a three-degree-of-freedom longitudinal dynamics model, and the device 1100 further includes:
[0170] The first building module is used to establish a single-vehicle longitudinal dynamics model of the target vehicle;
[0171] A second building module is used to build a front wheel model and a rear wheel model of the target vehicle;
[0172] The third construction module is used to form a three-degree-of-freedom longitudinal dynamics model of the target vehicle by combining the single-vehicle longitudinal dynamics model, the front wheel model and the rear wheel model.
[0173] Optionally, the vehicle dynamics model is established based on the road slope information of the road where the target vehicle is located, and the device 1100 further includes:
[0174] A second acquisition module, used to acquire vehicle motion information and second vehicle state measurement information of the target vehicle;
[0175] An input module, used for inputting the vehicle motion information and the second vehicle state measurement information into a road gradient estimator of the road where the target vehicle is located; the road gradient estimator is established based on a longitudinal acceleration model and an H-infinity filter;
[0176] The third estimation module is used to determine the road slope information of the road where the target vehicle is located through the road slope estimator based on the vehicle motion information, the second vehicle state measurement information, the second vehicle state estimation information of the target vehicle at a previous time step, and the third system noise covariance matrix and the third measurement noise covariance matrix of the road slope estimator at a previous time step.
[0177] Each module in the above-mentioned electric vehicle center of mass position joint estimation device can be implemented in whole or in part by software, hardware and their combination. Each module can be embedded in or independent of the processor in the computer device in the form of hardware, or can be stored in the memory of the computer device in the form of software, so that the processor can call and execute the corresponding operations of each module.
[0178] In an exemplary embodiment, a computer device is provided, which may be a terminal, and its internal structure diagram may be shown in FIG12. The computer device includes a processor, a memory, an input / output interface, a communication interface, a display unit, and an input device. The processor, the memory, and the input / output interface are connected via a system bus, and the communication interface, the display unit, and the input device are connected to the system bus via the input / output interface. The processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system and a computer program. The internal memory provides an environment for the operation of the operating system and the computer program in the non-volatile storage medium. The input / output interface of the computer device is used to exchange information between the processor and an external device. The communication interface of the computer device is used to communicate with an external terminal in a wired or wireless manner, and the wireless manner may be implemented through WIFI, a mobile cellular network, near field communication (NFC) or other technologies. When the computer program is executed by the processor, a method for jointly estimating the center of mass position of an electric drive vehicle is implemented. The display unit of the computer device is used to form a visually visible picture, which may be a display screen, a projection device, or a virtual reality imaging device. The display screen can be a liquid crystal display screen or an electronic ink display screen, and the input device of the computer device can be a touch layer covering the display screen, or a button, trackball or touchpad set on the computer device shell, or an external keyboard, touchpad or mouse.
[0179] Those skilled in the art will understand that the structure shown in FIG. 12 is merely a block diagram of a partial structure related to the solution of the present application, and does not constitute a limitation on the computer device to which the solution of the present application is applied. The specific computer device may include more or fewer components than shown in the figure, or combine certain components, or have a different arrangement of components.
[0180] In an exemplary embodiment, a computer device is provided, including a memory and a processor, wherein a computer program is stored in the memory, and the processor implements the steps in the above-mentioned method embodiments when executing the computer program.
[0181] In one embodiment, a computer-readable storage medium is provided, on which a computer program is stored. When the computer program is executed by a processor, the steps in the above method embodiments are implemented.
[0182] In one embodiment, a computer program product is provided, including a computer program, which implements the steps in the above method embodiments when executed by a processor.
[0183] It should be noted that the user information (including but not limited to user device information, user personal information, etc.) and data (including but not limited to data used for analysis, stored data, displayed data, etc.) involved in this application are all information and data authorized by the user or fully authorized by all parties, and the collection, use and processing of relevant data must comply with relevant regulations.
[0184] A person of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment method can be completed by instructing the relevant hardware through a computer program, and the computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, any reference to the memory, database or other medium used in the embodiments provided in the present application can include at least one of non-volatile memory and volatile memory. Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive random access memory (ReRAM), magnetic random access memory (MRAM), ferroelectric random access memory (FRAM), phase change memory (PCM), graphene memory, etc. Volatile memory can include random access memory (RAM) or external cache memory, etc. As an illustration and not limitation, RAM can be in various forms, such as static random access memory (SRAM) or dynamic random access memory (DRAM). The database involved in each embodiment provided in this application may include at least one of a relational database and a non-relational database. Non-relational databases may include distributed databases based on blockchains, etc., but are not limited to this. The processor involved in each embodiment provided in this application may be a general-purpose processor, a central processing unit, a graphics processor, a digital signal processor, a programmable logic device, a data processing logic device based on quantum computing, an artificial intelligence (AI) processor, etc., but are not limited to this.
[0185] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this application.
[0186] The above-described embodiments only express several implementation methods of the present application, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the present application. It should be pointed out that, for a person of ordinary skill in the art, several variations and improvements can be made without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the protection scope of the present application shall be subject to the attached claims.
Claims
1. A method for jointly estimating the center of mass position of an electric vehicle, characterized in that: The method comprises: Acquiring vehicle driving information and first vehicle state measurement information of a target vehicle; Inputting the first vehicle state measurement information into an H-infinity state filter of the target vehicle to obtain first vehicle state estimation information of the target vehicle; The vehicle driving information and the first vehicle state estimation information are input into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle; the H-infinity state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle.
2. The method according to claim 1, characterized in that The step of inputting the first vehicle state measurement information into the H-infinity state filter of the target vehicle to obtain the first vehicle state estimation information of the target vehicle includes: Inputting the first vehicle state measurement information into an H-infinity state filter of the target vehicle; The first vehicle state estimation information of the target vehicle is determined by the H infinite state filter according to the first vehicle state measurement information, the first vehicle state estimation information of the previous time step, and the first gain matrix of the H infinite state filter of the previous time step.
3. The method according to claim 2, characterized in that The method further comprises: Determine, by the H infinite state filter, a first error covariance matrix of the current time step of the H infinite state filter according to a first system noise covariance matrix, a first measurement noise covariance matrix and a first state covariance matrix of the current time step of the H infinite state filter, and a first error covariance matrix of a previous time step; The first gain matrix of the H infinite state filter at the current time step is determined by the H infinite state filter according to the first error covariance matrix of the current time step and the first measurement noise covariance matrix and the first state covariance matrix of the next time step of the H infinite state filter stored in advance.
4. The method according to claim 1, characterized in that The step of inputting the vehicle driving information and the first vehicle state estimation information into an extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle includes: inputting the vehicle driving information and the first vehicle state estimation information into an extended Kalman filter of the target vehicle; Determine, by means of the extended Kalman filter, a priori estimation of the center of mass position state of the target vehicle at the current time step according to the center of mass position information of the target vehicle at the previous time step; Determining, by the extended Kalman filter, an error covariance prior estimate of the current time step of the extended Kalman filter according to a second error covariance matrix of a previous time step of the extended Kalman filter and a second system noise covariance matrix; Determining, by the extended Kalman filter, a second gain matrix of the extended Kalman filter at the current time step according to the error covariance a priori estimate of the extended Kalman filter at the current time step and the second measurement noise covariance matrix, and the vehicle driving information; The extended Kalman filter is used to determine the center of mass position information of the target vehicle based on the vehicle driving information, the first vehicle state estimation information, the second gain matrix of the current time step, and the prior estimate of the center of mass position state of the current time step.
5. The method according to claim 1, characterized in that The vehicle dynamics model is a three-degree-of-freedom longitudinal dynamics model, and the method further includes: Establish a single-vehicle longitudinal dynamics model of the target vehicle; Establishing a front wheel model and a rear wheel model of the target vehicle; The single-vehicle longitudinal dynamics model, the front wheel model and the rear wheel model constitute a three-degree-of-freedom longitudinal dynamics model of the target vehicle.
6. The method according to claim 1, characterized in that The vehicle dynamics model is established based on the road slope information of the road where the target vehicle is located, and the method further includes: Acquire vehicle motion information and second vehicle state measurement information of the target vehicle; Inputting the vehicle motion information and the second vehicle state measurement information into a road gradient estimator of the road where the target vehicle is located; the road gradient estimator is established based on a longitudinal acceleration model and an H-infinity filter; The road slope information of the road where the target vehicle is located is determined by the road slope estimator based on the vehicle motion information, the second vehicle state measurement information, the second vehicle state estimation information of the target vehicle at the previous time step, and the third system noise covariance matrix and the third measurement noise covariance matrix of the road slope estimator at the previous time step.
7. A device for jointly estimating the center of mass position of an electric vehicle, characterized in that: The device comprises: A first acquisition module, used to acquire vehicle driving information and first vehicle state measurement information of a target vehicle; A first estimation module, configured to input the first vehicle state measurement information into an H-infinity state filter of the target vehicle to obtain first vehicle state estimation information of the target vehicle; The second estimation module is used to input the vehicle driving information and the first vehicle state estimation information into the extended Kalman filter of the target vehicle to obtain the center of mass position information of the target vehicle; the H-infinity state filter and the extended Kalman filter are established based on the vehicle dynamics model of the target vehicle.
8. A computer device comprising a memory and a processor, wherein the memory stores a computer program, wherein: When the processor executes the computer program, the steps of the method according to any one of claims 1 to 6 are implemented.
9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the method according to any one of claims 1 to 6 are implemented.
10. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, the steps of the method according to any one of claims 1 to 6 are implemented.
