A method, device, equipment and medium for determining vehicle quality
By introducing turning resistance in the longitudinal dynamic model, using parameters such as steering angle and lateral speed of the vehicle to determine the vehicle quality, the problem of inaccurate determination of vehicle quality under turning conditions in the prior art is solved, and the stability of the vehicle is improved Sex and mobility.
Patent Information
- Application Number
- CN202011553155.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-12-24
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2040-12-24
AI Technical Summary
The prior art cannot accurately determine the quality of the vehicle under the turning conditions of the vehicle, which affects the stability, mobility and smoothness of the vehicle.
Using a longitudinal dynamic model with turning resistance, by obtaining the parameters of the vehicle's steering angle, lateral speed, yaw angular velocity, longitudinal force and lateral force, combined with the longitudinal dynamic model, the vehicle's mass is determined, and the turning resistance is Establish relationships between quality to improve the accuracy of vehicle quality under cornering conditions.
It achieves an improvement in vehicle quality accuracy under cornering conditions, is suitable for straight and cornering conditions, and enhances the safety and stability of vehicle control.
Smart Images

Figure CN114670855B_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of vehicle control technology, and in particular to a method, device, equipment and medium for determining vehicle mass. Background Art
[0002] With the continuous development of digital technology and communication technology, intelligent driving has gradually come into people's vision, and intelligent driving has also ushered in unprecedented development opportunities. The key technologies in intelligent driving include perception and positioning, planning and decision-making, and execution and control. Generally, perception and positioning technology can determine the position of the vehicle, planning and decision-making technology can determine the control strategy for controlling the vehicle, and execution and control technology can control the vehicle according to the control strategy.
[0003] Among them, determining the control strategy for controlling the vehicle and controlling the vehicle according to the control strategy are heavily dependent on the vehicle's own factors and environmental factors, such as the vehicle's mass, road slope, etc. If the vehicle's mass cannot be accurately determined, the vehicle's stability, maneuverability and ride quality will be affected. Summary of the invention
[0004] The embodiments of the present application provide a method, device, equipment and medium for determining vehicle mass, which can improve the accuracy of vehicle mass under turning conditions.
[0005] In a first aspect, an embodiment of the present application provides a method for determining vehicle mass, which can be applied to electronic devices. The method specifically includes: obtaining a parameter set of the vehicle at a first moment, the parameter set including: the steering angle of each wheel in the vehicle, the lateral velocity, the yaw angular velocity, the longitudinal force and the lateral force of each wheel, and the parameter set is used to determine the turning resistance of the vehicle. The mass of the vehicle is determined according to the parameter set and the longitudinal dynamics model, wherein the longitudinal dynamics model is used to describe the longitudinal force balance of the vehicle, and the longitudinal force of the vehicle includes the turning resistance. In the embodiment of the present application, the turning resistance is introduced into the longitudinal dynamics model to expand the application scenario of determining the vehicle mass. The mass of the vehicle can also be determined when the vehicle is in a turning condition, and the mass of the vehicle under the turning condition is determined. In addition, in the embodiment of the present application, the parameter set of the vehicle at the first moment is obtained, and the magnitude of the turning resistance suffered by the vehicle at the first moment can also be determined. However, when the longitudinal dynamics model is used to determine the mass of the vehicle, it is not necessary to calculate the magnitude of the turning resistance. During the operation of the vehicle, the influence of the turning resistance on the longitudinal force of the vehicle is taken into account, and the accuracy of the mass determined by the vehicle under the turning condition is improved.
[0006] In a possible design, if the vehicle includes two steering wheels, the turning resistance and the parameter set satisfy the following formula:
[0007]
[0008] Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw rate of the vehicle. In the embodiment of the present application, when the vehicle includes two steering wheels, the electronic device can use the parameter set at the first moment and the relationship formula between the turning resistance and the parameter set provided in the embodiment of the present application to determine the relationship between the vehicle mass at the first moment and the turning resistance experienced by the vehicle at the first moment. Accurately determining the relationship between the turning resistance experienced by the vehicle and the mass helps to improve the accuracy of the longitudinal dynamics model in determining the vehicle mass.
[0009] In a possible design, if the vehicle includes four steering wheels, the turning resistance and the parameter set satisfy the following formula:
[0010]
[0011] Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw rate of the vehicle, where F y1 、F y2 The angles formed between the directions of the longitudinal velocity direction are greater than 90°, F y3 、F y4 The angles formed between the directions of the longitudinal speed direction are less than 90°. In the embodiment of the present application, when the vehicle includes four steering wheels, the electronic device can use the parameter set at the first moment and the relationship formula between the turning resistance and the parameter set provided in the embodiment of the present application to determine the relationship between the vehicle mass at the first moment and the turning resistance experienced by the vehicle at the first moment. Accurately determining the relationship between the turning resistance experienced by the vehicle and its mass helps to improve the accuracy of the longitudinal dynamics model in determining the vehicle mass.
[0012] In one possible design, the longitudinal dynamic model is F d =Fj +F w +F f +F i +F r , where F j is the acceleration resistance, F w is the air resistance, F f is the rolling resistance, F i is the slope resistance, F r is the turning resistance, F d As driving force.
[0013] In one possible design, the longitudinal dynamic model is F d =F j +F w +F f +F i +F b +F r , where F j is the acceleration resistance, F w is the air resistance, F f is the rolling resistance, F i is the slope resistance, F b is the braking force, F r is the turning resistance, F d As driving force.
[0014] In a possible design, after the electronic device obtains the parameter set of the vehicle at the first moment, it can determine the relationship between the mass of the vehicle and the turning resistance according to the relationship between the preset turning resistance and the parameter set and the parameter set. Then, the mass of the vehicle is determined according to the relationship and the longitudinal dynamic model. In the embodiment of the present application, the relationship between the preset turning resistance and the parameter set is also the relationship between the turning resistance and the mass. The relationship can also be understood as the relationship between the turning resistance, each physical quantity in the parameter set and the mass of the vehicle. The longitudinal dynamic model provided in the embodiment of the present application is used to describe the longitudinal force balance of the vehicle. The longitudinal force of the vehicle may include one or more of the driving force, braking force, air resistance, friction resistance, and acceleration resistance. The longitudinal force of the vehicle also includes the turning resistance of the vehicle. Other longitudinal forces except the turning resistance can be numerical values or in the form of the product of numerical values and the mass of the vehicle, such as the slope resistance is mgsinθ, θ is the road slope, which can be obtained by measurement or calculation. The electronic device can determine the mass of the vehicle by combining the relationship between the turning resistance and the mass of the vehicle and the longitudinal dynamic model and using the collected parameter set.
[0015] In a possible design, the electronic device can also use the longitudinal dynamics model and the relationship between the preset turning resistance and the parameter set to determine the first relationship between the vehicle mass, the longitudinal force other than the turning resistance, and the physical quantities in the parameter set. The first relationship can also be regarded as a deformation form of the longitudinal dynamics model. The electronic device can use the parameter set at any time and the first relationship to determine the mass of the vehicle at any time. In the process of determining the mass of the vehicle at any time, it is not necessary to determine the first relationship again.
[0016] In one possible design, the longitudinal dynamics model is Among them, F d is the driving force of the vehicle, F w is the air resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw angular velocity of the vehicle, f is the rolling resistance coefficient, δ is the rotation mass conversion coefficient, θ is the road slope, and a is the actual longitudinal acceleration of the vehicle.
[0017] In one possible design, the longitudinal dynamics model is Among them, F d is the driving force of the vehicle, F w The vehicle is the air resistance, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r The vehicle is the yaw rate, f is the rolling resistance coefficient, δ is the rotation mass conversion coefficient, θ is the road slope, a is the longitudinal acceleration of the vehicle, and F b For braking force.
[0018] In a possible design, after determining the mass of the vehicle according to the longitudinal dynamics model, the method further includes: determining the mass of the vehicle at a second moment according to the mass, wherein the second moment is after the first moment. In the embodiment of the present application, after determining the mass of the vehicle using the longitudinal dynamics model, the mass of the vehicle at the first moment is used to estimate the mass of the vehicle at any second moment after the first moment, so as to improve the accuracy of the mass determination.
[0019] In a possible design, the estimating the vehicle mass at the second moment includes: obtaining a first parameter set and a second parameter set of the vehicle at the second moment, the first parameter set including: road slope, longitudinal speed, lateral speed and yaw rate, the second parameter set including: steering angle of each wheel in the vehicle, lateral speed, yaw rate, longitudinal force and lateral force of each wheel, driving force and air resistance; determining a first input value, the first input value is determined according to a preset rolling friction parameter, a preset rotational mass conversion coefficient and the first parameter set; determining a second input value, the second input value is determined according to the second parameter set; determining a first value according to the first input value, the second input value and the mass of the vehicle at the first moment, the first value is an estimated value of the mass of the vehicle at the second moment; determining the mass of the vehicle at the second moment according to the first value and the first mass threshold and the second mass threshold. In the embodiment of the present application, the mass of the vehicle at the second moment is determined according to the first input value determined by the first parameter set obtained at the second moment, the second input value determined by the second parameter set obtained at the second moment and the mass of the vehicle at the first moment. It can realize real-time determination of the vehicle mass at the second moment, that is, realize real-time identification of the mass of the entire vehicle, and can adapt to complex and changeable driving conditions.
[0020] In a possible design, when determining the vehicle mass at the second moment according to the first numerical value, if the first numerical value is less than or equal to the first mass threshold, the first mass threshold is determined as the vehicle mass at the second moment; if the first numerical value is greater than or equal to the second mass threshold, the second mass threshold is determined as the vehicle mass at the second moment; if the first numerical value is greater than the first mass threshold and the first numerical value is less than the second mass threshold, the first numerical value is determined as the vehicle mass at the second moment. In an embodiment of the present application, after determining the first numerical value, the first numerical value is compared with the unloaded mass of the vehicle and the fully loaded mass of the vehicle. The first mass threshold may be the unloaded mass of the vehicle, and the second mass threshold may be the fully loaded mass of the vehicle. The vehicle mass at the second moment determined by comparing the first numerical value with the first mass threshold and the second mass threshold can conform to the actual vehicle operating state and help control the vehicle.
[0021] In a possible design, the longitudinal force of the vehicle also includes the slope resistance of the vehicle; the electronic device can also determine the slope of the road where the vehicle is located at the first moment, and the slope is used to determine the slope resistance; when the electronic device determines the first mass of the vehicle according to the parameter set and the longitudinal dynamics model, it can determine the mass of the vehicle according to the parameter set, the slope and the longitudinal dynamics model. In the embodiment of the present application, the mass of the whole vehicle is decoupled from the road slope, so that the identification of the road slope is not affected by the vehicle mass and the turning resistance.
[0022] In a possible design, determining the slope of the road where the vehicle is located at the first moment includes: obtaining the longitudinal acceleration signal and the longitudinal velocity signal of the vehicle at the first moment; denoising the longitudinal acceleration signal and the longitudinal velocity signal; determining a second value based on the denoised longitudinal acceleration signal, the denoised longitudinal velocity signal and the slope determined last time, the second value being an estimated value of the road slope at the first moment; determining the slope of the road where the vehicle is located at the first moment based on the second value and the slope threshold. In the embodiment of the present application, considering the influence of external interference and sudden changes in sensor signals on the longitudinal acceleration signal and the longitudinal velocity signal, the accuracy of determining the road slope is improved by denoising the longitudinal acceleration signal and the longitudinal velocity signal, which helps to improve the accuracy and precision of vehicle quality.
[0023] In a possible design, when determining the slope of the road where the vehicle is located at the first moment according to the second numerical value, if the absolute value of the second numerical value is less than the slope threshold, the second numerical value is determined as the slope of the road where the vehicle is located at the first moment; if the absolute value of the second numerical value is greater than or equal to the slope threshold, and the second numerical value is less than zero, the opposite of the slope threshold is determined as the slope of the road where the vehicle is located at the first moment; if the absolute value of the second numerical value is greater than or equal to the slope threshold, and the second numerical value is greater than zero, the slope threshold is determined as the slope of the road where the vehicle is located at the first moment. In an embodiment of the present application, after determining the second numerical value, the second numerical value is compared with the slope threshold. Among them, the slope threshold can be the maximum road slope. The road surface determined by comparing the second numerical value with the slope threshold can conform to the actual vehicle operating state, which helps to improve the accuracy of determining the vehicle quality.
[0024] In a second aspect, an embodiment of the present application further provides a device for determining vehicle mass, which has the function of implementing the above-mentioned first aspect and any possible design of the first aspect. The function can be implemented by hardware, or by hardware executing corresponding software. The hardware or software includes one or more modules corresponding to the above-mentioned functions.
[0025] In a third aspect, the present application provides an electronic device, comprising: a processor and a memory. The memory is used to store computer-executable instructions, and when the electronic device is running, the processor executes the computer-executable instructions stored in the memory to enable the device to perform the method involved in the first aspect or any one of the designs in the first aspect.
[0026] According to a fourth aspect, a computer storage medium is provided, storing a computer program, wherein the computer program includes instructions for executing the methods of the above aspects.
[0027] According to a fifth aspect, a computer program product comprising instructions is provided, which, when executed on a computer, enables the computer to execute the methods described in the above aspects.
[0028] In a sixth aspect, a chip is provided, the chip comprising a processor, and when the processor executes an instruction, the processor is used to execute the method involved in the first aspect or any one of the designs in the first aspect. The instruction may come from a memory inside the chip or from a memory outside the chip. Optionally, the chip also includes an input and output circuit.
[0029] Among them, the technical effects brought about by any design in the second to sixth aspects can refer to the technical effects brought about by the corresponding methods above, and will not be repeated here. BRIEF DESCRIPTION OF THE DRAWINGS
[0030] Figure 1 It is a schematic diagram of the longitudinal force condition of a vehicle in the prior art;
[0031] Figure 2 A schematic diagram of a vehicle system architecture provided in an embodiment of the present application;
[0032] Figure 3 A schematic diagram of a vehicle system architecture provided in an embodiment of the present application;
[0033] Figure 4 A schematic diagram of a longitudinal dynamics model provided in an embodiment of the present application;
[0034] Figure 5 A schematic flow chart of a method for determining vehicle mass provided in an embodiment of the present application;
[0035] Figure 6 A schematic diagram of another longitudinal dynamic model provided in an embodiment of the present application;
[0036] Figure 7 A schematic diagram of another longitudinal dynamics model provided in an embodiment of the present application;
[0037] Figure 8A schematic diagram of another longitudinal dynamics model provided in an embodiment of the present application;
[0038] Fig. 9 A schematic diagram of another longitudinal dynamics model provided in an embodiment of the present application;
[0039] Fig.10 A schematic diagram of another longitudinal dynamics model provided in an embodiment of the present application;
[0040] Fig.11 A schematic flow chart of a method for determining vehicle mass provided in an embodiment of the present application;
[0041] Fig.12 A schematic flow chart of a method for determining a road surface slope provided in an embodiment of the present application;
[0042] Fig.13 A schematic diagram of the structure of a vehicle mass determination device provided in an embodiment of the present application;
[0043] Fig.14 A schematic diagram of the structure of another device for determining vehicle mass provided in an embodiment of the present application. DETAILED DESCRIPTION
[0044] In order to make the purpose, technical solutions and advantages of the embodiments of the present application clearer, the technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application.
[0045] With the continuous development of digital technology and communication technology, intelligent driving has gradually come into people's vision, and intelligent driving has also ushered in unprecedented development opportunities. The key technologies in intelligent driving include perception and positioning, planning and decision-making, and execution and control. Generally, perception and positioning technology can determine the position of the vehicle, planning and decision-making technology can determine the control strategy for controlling the vehicle, and execution and control technology can control the vehicle according to the control strategy.
[0046] Among them, determining the control strategy for controlling the vehicle and controlling the vehicle according to the control strategy are heavily dependent on the vehicle's own factors and environmental factors, such as the vehicle's mass, road slope, etc. If the vehicle's mass cannot be accurately determined, the vehicle's stability, maneuverability and ride quality will be affected.
[0047] At present, the dynamic models used in the commonly used methods for determining the mass of a vehicle include driving force, acceleration resistance, air resistance, rolling resistance and slope resistance. Figure 1 The vehicle longitudinal dynamics model used in the existing method for determining the vehicle mass is shown in FIG. In the longitudinal direction, the forces acting on the vehicle include the acceleration resistance F j , air resistance F w , rolling resistance F f, Slope resistance F i , and the driving force F d The existing vehicle longitudinal dynamics model is F d =F j +F w +F f +F i .
[0048] The existing vehicle longitudinal dynamics model is only applicable to the vehicle in straight-line conditions. However, when the vehicle is turning, the vehicle is affected by the turning resistance, causing the vehicle speed to decrease. When the vehicle is turning, it still uses the longitudinal dynamics model in the straight-line condition, which cannot accurately determine the vehicle mass, greatly limiting the safety, stability, and maneuverability of controlling the vehicle in intelligent driving scenarios.
[0049] Based on this, the embodiment of the present application provides a method and device for determining vehicle mass, which can determine the mass of the entire vehicle through a longitudinal motion mechanics model with turning resistance, and can determine the mass of the vehicle under turning conditions. Among them, the method and the device are based on the same concept, and since the principles of solving the problem by the method and the device are similar, the implementation of the device and the method can refer to each other, and the repeated parts will not be repeated.
[0050] See also Figure 2 As shown in the vehicle system architecture diagram, the vehicle may include a signal acquisition module, an on-board electronic control system, an actuator, etc. Among them, the signal acquisition module may include a longitudinal velocity sensor, a longitudinal acceleration sensor, a yaw rate sensor, and other vehicle state sensors. The signal acquisition module can collect vehicle state parameters such as longitudinal velocity, longitudinal acceleration, yaw rate, etc. in real time, and send the collected data or signals to the information processing module in the on-board electronic control system.
[0051] The actuator includes actuators such as steering wheels, motors or engines, brakes, etc. The actuator can control the corresponding actuators according to the control instructions of the decision control module.
[0052] The vehicle-mounted electronic control system may include an information processing module and a decision control module. The information processing module may execute the method for determining the vehicle mass provided in the embodiment of the present application to determine the vehicle mass and other data. The decision control module makes a decision plan and corresponding dynamic control for the vehicle according to the vehicle mass determined by the information processing module.
[0053] The decision control module in the vehicle electronic control system sends execution parameters, such as steering wheel angle, driving torque, braking force or other instructions to the execution device.
[0054] The method for determining vehicle mass provided in the embodiment of the present application is applied to an electronic device, and the electronic device can be applied to a vehicle, such as Figure 3As shown, the vehicle system may include, but is not limited to, vehicle sensors, driver input devices (such as steering wheels, pedals, manual gear rockers, automatic gear controllers, etc.), advanced driver assistance systems (ADAS), vehicle controllers, torque execution units, and the like. Among them, the vehicle sensors are used to collect vehicle status information such as longitudinal acceleration and yaw rate. The advanced driver assistance system can detect the steering requirements of the vehicle, etc. The vehicle controller can control the vehicle's driving and stability, and further, the vehicle controller can execute the method for determining the vehicle mass provided in the embodiment of the present application. The vehicle controller obtains various data from the on-board sensors, driver input devices, and ADAS, and determines the vehicle mass according to the kinematic mechanics model with turning resistance. The vehicle controller can also automatically switch the control targets of maneuverability and stability and calculate the control amount according to the determined vehicle mass, and convert the control amount into the driving\braking torque requirement of the wheel. The torque execution unit can be used to receive the wheel torque requirement from the vehicle controller, apply braking or driving torque to the wheel, and realize the maneuverability and stability control of the vehicle. Optionally, the torque execution unit may include a motor control unit, a hydraulic control unit, and the like.
[0055] The torque execution unit can be used to receive wheel torque requirements from the vehicle controller, apply braking or driving torque to the wheels, and achieve vehicle maneuverability and stability control. The torque execution unit may include a motor control unit, a hydraulic control unit, etc.
[0056] It should be noted that Figure 3 The system architecture shown does not constitute a limitation on the front and rear axle distributed drive vehicles to which the embodiments of the present application are applicable, and the front and rear axle distributed drive vehicles may include more or fewer components. For example, when the front and rear axle distributed drive vehicle does not have an autonomous driving function, it does not contain ADAS. For another example, when the front and rear axle distributed drive vehicle only has an autonomous driving function but does not have a manual driving function, it does not contain a driver input device. For another example, when the front and rear axle distributed drive vehicle has both an autonomous driving function and a manual driving function, it contains ADAS and a driver input device.
[0057] In addition, it should be noted that in the embodiments of the present application, the parameters that can be changed in real time can be recorded as a function with time t as a variable, and t can represent the current time. Of course, the parameters calculated or estimated based on the function with t as a variable are also recorded as a function with t as a variable.
[0058] For example, in Figure 3In the system architecture shown, the longitudinal acceleration, yaw rate, steering angle of each tire, longitudinal force of each tire, and lateral force can be measured by the vehicle sensors, which can be denoted as a(t), w r (t), β i (t), F xi (t), F yi (t)(i=1,2,3,4…).
[0059] Optionally, the steering angle of each tire can be obtained by estimation. For example, the vehicle-mounted sensor can measure the rotation angle of the steering wheel. The steering angle of each tire is determined by the calibration relationship between the rotation angle of the steering wheel and the steering angle of each tire.
[0060] Optionally, the yaw angular velocity may be obtained by estimation. For example, the vehicle-mounted sensor may measure the wheel speed of each tire, the steering angle of each tire, the lateral acceleration of the vehicle, and the longitudinal acceleration of the vehicle, and determine the yaw angular velocity by estimation. The yaw angular velocity obtained by estimation may also be corrected, and the corrected yaw angular velocity is determined as the yaw angular velocity of the vehicle.
[0061] Optionally, the longitudinal force and lateral force of each tire may be obtained by estimation, for example, by using parameters such as the wheel speed of each tire, the side slip angle of each tire, and the vertical load signal of each tire.
[0062] Optionally, the on-board sensors may include a torque sensor for measuring the driving torque provided by the engine or the motor.
[0063] Optionally, the vehicle-mounted sensor may include a cylinder pressure sensor for measuring the wheel cylinder pressure, so as to facilitate the determination of the braking force. The vehicle-mounted sensor may also include an angle sensor for measuring the opening and closing angle of the pedal, so as to facilitate the determination of the braking force through a pre-calibrated angle and braking force spectrum (corresponding relationship).
[0064] Since the calculation methods of the above parameters are existing and relatively complicated, they will not be elaborated in detail in the embodiments of the present application.
[0065] like Figure 4 A method for determining vehicle mass is shown in Figures 5 to 8The vehicle shown in . The method is executed by a device for determining the mass of a vehicle. The device for determining the mass of a vehicle may be a vehicle controller, or an independent electronic device independent of the vehicle controller, or various on-board devices coupled with a function of determining the mass of a vehicle. In the following embodiments, the device for determining the mass of a vehicle may be referred to as an electronic device. In addition, in the embodiments of the present application, the vehicle may be a vehicle of the type of two-wheel steering, four-wheel steering, or a vehicle with more steering wheels than four wheels, and the present application does not limit this. The method comprises at least the following steps:
[0066] Step S401, obtaining a parameter set of the vehicle at the first moment, the parameter set including: the steering angle, lateral velocity, yaw angular velocity, longitudinal force and lateral force of each wheel in the vehicle, and the parameter set is used to determine the turning resistance.
[0067] In specific implementation, the vehicle sensor module can measure the parameters such as the steering angle, lateral velocity, yaw rate, longitudinal force and lateral force of each wheel in the vehicle at the first moment (for example, moment t), and send the measured parameters to the vehicle controller. The parameter set at the first moment obtained by the vehicle controller can be used to determine the turning resistance, so that the vehicle controller can determine the mass of the vehicle under the turning condition according to the parameter set at the first moment.
[0068] Step S402, determining the mass of the vehicle according to the parameter set and the longitudinal dynamics model, wherein the longitudinal dynamics model is used to describe the longitudinal force balance of the vehicle, and the longitudinal force of the vehicle includes the turning resistance.
[0069] In the embodiment of the present application, the electronic device determines the vehicle mass using the longitudinal dynamics model including the turning resistance, which can improve the accuracy of the vehicle mass under the turning condition. When the vehicle is in the straight-moving condition, the turning resistance in the longitudinal dynamics model including the turning resistance is zero, and the vehicle mass can also be determined using the longitudinal dynamics model. Therefore, the longitudinal dynamics model provided by the present application is applicable to both the turning condition and the straight-moving condition.
[0070] In one example, the vehicle may be a front-wheel steering vehicle type, for example, the vehicle includes four wheels, and when the vehicle turns, the front two wheels deflect to form a steering angle with the longitudinal direction of the vehicle. Figure 5 The figure shows the force of the vehicle under the turning condition. The vehicle is subjected to the acceleration resistance F j , air resistance F w , rolling resistance F f , Slope resistance F i , driving force F d And the turning resistance F r .
[0071] The embodiment of the present application provides a longitudinal dynamics model Fd =F j +F w +F f +F i +F r Among them, the turning resistance F r It can be determined by the steering angle, lateral velocity, yaw rate, longitudinal force and lateral force of each wheel.
[0072] For example, the turning resistance is determined by the following formula:
[0073] F r =F x1 (1-cosβ1)+F x2 (1-cosβ2)+F y1 sinβ1+F y2 sinβ2-mvw r .
[0074] Among them, F xi is the longitudinal force on the ith tire (i=1,2,3,4), F yi is the total lateral force of the i-th tire, β1 is the steering angle of the first tire, β2 is the steering angle of the second tire, v is the lateral speed of the vehicle, and w r is the yaw angular velocity, and m is the vehicle mass.
[0075] Driving force F d is the longitudinal force F on each tire of the vehicle xi The sum of the driving force F d It can be determined by the driving force torque provided by the engine or motor, such as T aq The driving torque provided by the engine or motor, i t is the transmission ratio from the engine or motor to the wheels, η is the mechanical efficiency of the transmission system, and r is the wheel radius.
[0076] Acceleration resistance F j The value of can be obtained by formula F j =δma, where δ is the rotational mass conversion factor, m is the vehicle mass, and a is the true value of the vehicle longitudinal acceleration. And, u(t) is the longitudinal velocity of the vehicle.
[0077] Air resistance F w The value of can be obtained by the formula Calculate, where C D is the air resistance coefficient, A is the frontal area of the vehicle, and u is the longitudinal speed of the vehicle.
[0078] Rolling resistance F f The value of can be obtained by formula Ff =fmgcosθ, where f is the rolling resistance coefficient, m is the vehicle mass, g is the acceleration of gravity, and θ is the road slope.
[0079] Slope resistance F i The value of can be obtained by formula F i =mgsinθ, where m is the mass of the vehicle, g is the acceleration due to gravity, and θ is the slope of the road.
[0080] A modified form of the longitudinal dynamics model provided in the embodiment of the present application can be expressed as: d =δma+F w +fmgcosθ+mgsinθ+F x1 (1-cosβ1)+F x2 (1-cosβ2)+F y1 sinβ1+F y2 sinβ2-mvw r The electronic device can calculate the acceleration resistance, rolling resistance, slope resistance and turning resistance values related to mass without calculating them. The electronic device can use the mass-related forces and mass-independent forces in the longitudinal forces of the vehicle in combination with the longitudinal dynamics model to determine the vehicle mass. For example,
[0081] The electronic device can determine the driving force F at the first moment (for example, moment t) in advance by the above-mentioned method for determining the driving force and air resistance. d (t), air resistance F w (t). The electronic device may also pre-configure a rolling friction parameter f and a rotational mass conversion factor δ.
[0082] When the electronic device determines the mass of the vehicle according to the longitudinal dynamics model, it can be based on the longitudinal dynamics model provided in the above embodiment of the present application or its modified form showing the relationship between the mass and the longitudinal force of the vehicle, such as Determine the vehicle mass m(t) at the first moment.
[0083] In one possible implementation, the driver usually brakes while turning. Or, in an intelligent driving scenario, the vehicle controller controls the vehicle's braking to ensure the vehicle's stability. Therefore, the vehicle will also be subject to braking force (such as Figure 6 The present application embodiment provides another longitudinal dynamics model, which can be expressed as F d =F j +F w +F f +F i +Fr +F b Among them, F b is the braking force. A variant of this longitudinal dynamic model can be expressed as
[0084] The electronic device can obtain the braking force F at the first moment (such as moment t) in advance by the above braking force determination method. b The electronic device may determine the vehicle mass at the first moment by combining the acquired parameter set at the first moment and the longitudinal dynamics model.
[0085] To facilitate understanding of the longitudinal dynamics model with turning resistance provided in the embodiment of the present application, the process of determining the longitudinal dynamics model with turning resistance is briefly described below. Since the vehicle is in a yaw state under a turning condition, and the steering wheel forms a steering angle with the longitudinal direction of the vehicle, the longitudinal force and lateral force of the tire change the longitudinal force of the vehicle.
[0086] like Figure 6 The force of the vehicle under the turning condition can be firstly established by establishing the longitudinal dynamic equilibrium equation, F j +F w +F f +F i +F b +F y1 sinβ1+F y2 sinβ2-mvw r =F x1 cosβ1+F x2 cosβ2+F x3 +F x4 Then the longitudinal dynamic equilibrium equation is combined with the relationship between the vehicle driving force and the longitudinal force of each tire (driving force F d is the longitudinal force F of each tire xi The relationship between driving force, air resistance, slope resistance, rolling resistance, acceleration resistance, and braking force can be obtained by combining F d =F j +F w +F f +F b +F i +F x1 (1-cosβ1)+F x2 (1-cosβ2)+F y1 sinβ1+F y2 sinβ2-mvw r Among them, F x1 (1-cosβ1)+F x2 (1-cosβ2)+F y1 sinβ1+Fy2 sinβ2-mvw r is the turning resistance F r .
[0087] In actual application scenarios, if you need to calculate the turning resistance F of a vehicle under turning conditions, r It can be determined based on the driving force, braking force, acceleration resistance, rolling resistance, and slope resistance of the vehicle when turning, such as F r =F d -F j -F w -F f -F b -F i . Turning resistance F r It can also be determined based on the longitudinal force, lateral force, steering angle, vehicle mass, lateral velocity, and yaw rate of the steering tire, such as F r =F x1 (1-cosβ1)+F x2 (1-cosβ2)+F y1 sinβ1+F y2 sinβ2-mvw r .
[0088] In another example, the vehicle may be a four-wheel steering vehicle type, for example, the vehicle includes four wheels, and when the vehicle turns, the four wheels are deflected to form a steering angle with the longitudinal direction of the vehicle. Figure 7 The figure shows the force of the vehicle under the turning condition. The vehicle is subjected to the acceleration resistance F j , air resistance F w , rolling resistance F f , Slope resistance F i , driving force F d And the turning resistance F r .
[0089] The longitudinal dynamics model (F d =F j +F w +F f +F i +F r ), the turning resistance F r It can be expressed as: It can also be expressed as F r =F x1 (1-cosβ1)+F x2 (1-cosβ2)+F x3 (1-cosβ3)+F x4 (1-cosβ4)+F y1 sinβ1+F y2sinβ2-F y3 sinβ3-F y4 sinβ4-mvw r .
[0090] Among them, F yi is the lateral force of the i-th steering wheel, F y1 、F y2 The angles formed between the directions of the vehicle and the longitudinal speed direction are greater than 90°, F y3 、F y4 The angles formed between the directions and the longitudinal speed direction of the vehicle are less than 90°.
[0091] In other words, the deflection direction of tire 1 or tire 2 is the same as the deflection direction of the vehicle, and the deflection direction of tire 3 or tire 4 is opposite to the deflection direction of the vehicle. For example, if the deflection direction of the vehicle is counterclockwise, the deflection direction of tire 1 or tire 2 is also counterclockwise. And the deflection direction of tire 3 or tire 4 is clockwise. For four-wheeled vehicles in real life, the wheels indicated by tire 1 and tire 2 are the left front wheel and the right front wheel of the vehicle respectively, and the wheels indicated by tire 3 and tire 4 are the left rear wheel and the right rear wheel of the vehicle respectively.
[0092] A variation of the longitudinal dynamics model provided in the embodiment of the present application can be expressed as: The electronic device can calculate the acceleration resistance, rolling resistance, slope resistance and turning resistance values related to mass without calculating them. The electronic device can use the mass-related forces and mass-independent forces in the longitudinal forces of the vehicle in combination with the longitudinal dynamics model to determine the vehicle mass. For example,
[0093] In a possible implementation, the vehicle is also subjected to braking force (such as Figure 8 The present application embodiment provides another longitudinal dynamics model, which can be expressed as F d =F j +F w +F f +F i +F r +F b Among them, F b is the braking force. A variant of this longitudinal dynamic model can be expressed as
[0094] The electronic device can obtain the braking force F at the first moment (such as moment t) in advance by the aforementioned braking force determination method. bThe electronic device may determine the vehicle mass at the first moment by combining the acquired parameter set at the first moment and the longitudinal dynamics model.
[0095] The following is a brief introduction to the process of determining the longitudinal dynamics model of a four-wheel steering vehicle. Since the vehicle is in a yaw state during a turn, and the steering wheel forms a steering angle with the longitudinal direction of the vehicle, the longitudinal force and lateral force of the tire change the longitudinal force of the vehicle.
[0096] According to Figure 8 The longitudinal dynamic equilibrium equation can be expressed as: F j +F w +F f +F i +F b +F y1 sinβ1+F y2 sinβ2-mvw r =F x1 cosβ1+F x2 cosβ2+F x3 cosβ3+F x4 cosβ4+F y3 sinβ3+F y4 sinβ4.
[0097] The longitudinal dynamics equilibrium equation is combined with the relationship between the vehicle driving force and the longitudinal force of each tire (driving force F d is the longitudinal force F of each tire xi The relationship between driving force, air resistance, slope resistance, rolling resistance, and acceleration resistance can be obtained by combining the total of F d =F j +F w +F f +F b +F i +F x1 (1-cosβ1)+F x2 (1-cosβ2)+F x3 (1-cosβ3)+F x4 (1-cosβ4)+F y1 sinβ1+F y2 sinβ2-F y3 sinβ3-F y4 sinβ4-mvw r .
[0098] Among them, F x1 (1-cosβ1)+F x2 (1-cosβ2)+F x3 (1-cosβ3)+Fx4 (1-cosβ4)+F y1 sinβ1+F y2 sinβ2-F y3 sinβ3-F y4 sinβ4-mvw r is the turning resistance F r .
[0099] In more vehicle operation scenarios, the vehicle may also have more than four wheels, such as a truck. The longitudinal dynamics model F provided in the embodiment of the present application d =F j +F w +F f +F i +F r It can also be applied to vehicles with more than 4 wheels. Among them, the 1st to jth tires are tires whose deflection direction is the same as the deflection direction of the vehicle, and the j+1st to nth tires are tires whose deflection direction is opposite to the deflection direction of the vehicle. In other words, when the vehicle turns, the 1st to jth tires are tires whose angles formed between the lateral force and the longitudinal speed direction are greater than 90°, and the j+1st to nth tires are tires whose angles formed between the lateral force and the longitudinal speed direction are less than 90°.
[0100] The vehicle has more than 4 tires, some of which are non-steering tires. Fig. 9 As shown, a vehicle has 6 tires, of which tire 5 and tire 6 are non-steering tires. The deflection angle of the non-steering tires when the vehicle turns is 0°. Since β = 0°, and the value of sinβ is also 0, the non-steering tires have no effect on determining the turning resistance of the vehicle, and therefore have no effect on determining the mass of the vehicle. In the longitudinal dynamics model, the non-steering tires can be regarded as tires with the same deflection direction as the vehicle, or as tires with a deflection direction opposite to the vehicle.
[0101] In a scenario where the vehicle includes more than 4 wheels and has 4 steering wheels, the longitudinal dynamics model (F d =F j +F w +F f +F i +F r ) is a transformed form of Where n is the number of vehicle tires, F xi is the longitudinal force of the ith tire, F yiis the lateral force of the i-th tire. The 1st to j-th tires are tires with an angle greater than 90° between the lateral force and the longitudinal velocity direction, and the j+1th to n-th tires are tires with an angle less than 90° between the lateral force and the longitudinal velocity direction.
[0102] In a possible implementation manner, if the vehicle includes four steering wheels, in the above step S402, when the electronic device determines the mass of the vehicle according to the longitudinal dynamics model, the electronic device may determine the mass and the longitudinal force of the vehicle according to the longitudinal dynamics model provided in the above embodiment of the present application or its modified form, such as Determine the vehicle mass m(t) at the first moment.
[0103] Considering that the vehicle may be subjected to braking force in the longitudinal direction during the turning process, another longitudinal dynamics model (F d =F j +F w +F f +F i +F r +F b ) is a transformed form of Where n is the number of vehicle tires, F xi is the longitudinal force of the ith tire, F yi is the lateral force of the i-th tire. The angle formed between the 1st to j-th tires and the longitudinal velocity direction of the vehicle is greater than 90° (including non-steering tires), and the angle formed between the j+1-th tire to the n-th tire and the longitudinal velocity direction of the vehicle is less than 90°.
[0104] In the above step S402, when the electronic device determines the mass of the vehicle according to the longitudinal dynamics model, the electronic device may determine the mass of the vehicle according to the longitudinal dynamics model provided in the above embodiment of the present application or the relationship between the mass and the longitudinal force of the vehicle shown in its variant form, such as Determine the vehicle mass m(t) at the first moment.
[0105] The method for determining vehicle mass provided in the present application can also be applied to vehicles with more than 4 steering tires. Fig.10 The vehicle shown has 6 tires, and all 6 tires are steering wheels. The turning resistance of the vehicle when turning Fig.10 In the deflection conditions of the wheels shown in FIG. 1 , tire 1 and tire 2 are tires whose deflection directions are the same as the deflection direction of the vehicle. Tire 3, tire 4, tire 5, and tire 6 are tires whose deflection directions are opposite to the deflection direction of the vehicle.
[0106] In another possible implementation, after determining the vehicle mass at the first moment, the electronic device may use the vehicle mass at the first moment to estimate the vehicle mass at the second moment, wherein the second moment is after the first moment. Fig.11 The method for determining vehicle mass shown in , comprises the following steps:
[0107] Step S1101, obtaining a first parameter set and a second parameter set of the vehicle at a second moment, wherein the first parameter set includes: road slope, longitudinal speed, lateral speed and yaw angular velocity, and the second parameter set includes: steering angle, lateral speed, yaw angular velocity of each wheel in the vehicle, longitudinal force and lateral force of each wheel, driving force and air resistance.
[0108] The vehicle sensor module can measure the longitudinal speed, lateral speed, yaw rate, steering angle of each wheel, lateral speed, longitudinal force and lateral force of each wheel at the second moment (such as t+1 moment). The electronic device can obtain the aforementioned parameters measured by the vehicle sensor module, and can also obtain parameters such as driving force, air resistance, and road slope. Among them, the road slope, longitudinal speed, lateral speed, and yaw rate are parameters in the first parameter set, and the steering angle, lateral speed, yaw rate, longitudinal force and lateral force of each wheel, driving force, and air resistance of each wheel in the vehicle are parameters in the second parameter set.
[0109] Step S1102, determining a first input value, where the first input value is determined based on a preset rolling friction parameter, a preset rotational mass conversion coefficient, and a first parameter set.
[0110] The electronic device may determine the first input value x using the parameters in the first parameter set, the preset rolling friction parameter, and the preset rotation mass conversion coefficient. m (t+1). The electronic device can be calculated by the formula x m =fgcosθ+gsinθ+δa-vw r , determine the first input value. Where a is the true value of the vehicle's longitudinal acceleration, which can be obtained by the formula Determine the true value of the longitudinal acceleration, u(t) is the longitudinal velocity of the vehicle.
[0111] Step S1103: determine a second input value, where the second input value is determined according to a second parameter set.
[0112] The electronic device can use the parameters in the first parameter set to determine the second input value y m (t+1).
[0113] In one example, if the vehicle includes two steering wheels, the electronic device can calculate the steering wheel by the formula y m =F d -Fw -F x1 (1-cosβ1)-F x2 (1-cosβ2)-F y1 sinβ1-F y2 sinβ2, determine the second input value. If the longitudinal dynamics model with turning resistance used by the electronic device includes braking force when determining the vehicle mass at the first moment, the electronic device can use the formula y m =F d -F w -F b -F x1 (1-cosβ1)-F x2 (1-cosβ2)-F y1 sinβ1-F y2 sinβ2, determines the second input value.
[0114] In another example, if the vehicle includes four steered wheels, the electronic device can use the formula Determine the second input value. Where, F yi is the lateral force of the i-th steering wheel, F y1 、F y2 The angles formed between the directions of the vehicle and the longitudinal speed direction are greater than 90°, F y3 、F y4 The angles formed between the directions of and the longitudinal velocity direction of the vehicle are less than 90°. If the longitudinal dynamics model with turning resistance used by the electronic device includes braking force when determining the vehicle mass at the first moment, the electronic device can use the formula A second input value is determined.
[0115] Step S1104, determining a first numerical value according to the first input value, the second input value and the mass of the vehicle at the first moment, wherein the first numerical value is an estimated value of the mass of the vehicle at the second moment.
[0116] The electronic device can be configured to input a first value x according to the first input value x. m (t+1), the second input value y m (t+1), the vehicle mass m(t) at the first moment (such as moment t), and the Kalman prediction method are used to estimate the vehicle mass at the second moment to obtain a first value, which can be the vehicle mass at moment t+1.
[0117] Electronic devices can also use neural network models to predict the vehicle mass at the second moment.
[0118] The electronic device can also use a least squares identification model with a forgetting factor to determine the vehicle mass at the second moment. Specifically, the least squares identification model with a forgetting factor provided by the present application for determining the vehicle mass is specifically shown as follows:
[0119]
[0120] Among them, m is the identification amount, x m is the observed quantity, y m is the output, K m is the gain vector, P m is the covariance, λ m is the forgetting factor. θ It can be a value not less than 0.9 and not greater than 1. In practice, the electronic device can continuously perform self-iteration using the least squares identification model with a forgetting factor. θ It can be a fixed value or a value set by the electronic device according to other sampled data.
[0121] x m (t+1) is the first input value, y m (t+1) is the second input value, and m(t) is the vehicle mass at the first moment. Using the least squares identification model with a forgetting factor, the first value can be determined, which is also the vehicle mass m(t+1) at the second moment obtained by the electronic device through estimation.
[0122] Step S1105, determining the vehicle mass at the second moment according to the first value and the first mass threshold and the second mass threshold.
[0123] In order to avoid abnormality of the determined vehicle mass due to sensor abnormality and other reasons, the electronic device further compares the determined vehicle mass with a mass threshold. The mass threshold includes a first mass threshold m0 and a second mass threshold m1. The first mass threshold m0 may be the unloaded mass of the vehicle, and the second mass threshold m1 may be the fully loaded mass of the vehicle.
[0124] If the first value is less than or equal to the first mass threshold m0, the first mass threshold m0 is determined as the vehicle mass at the second moment; or,
[0125] If the first value is greater than or equal to the second mass threshold m1, the second mass threshold m1 is determined as the vehicle mass at the second moment; or,
[0126] If the first value is greater than the first mass threshold m0 and less than the second mass threshold m1, the first value is determined as the vehicle mass at the second moment.
[0127] The electronic device may use the vehicle mass at the second moment determined in step S1105 to control the vehicle, for example, to determine control parameters.
[0128] The method for determining vehicle mass provided in the above embodiments of the present application is also applicable to the scenario where the vehicle is in a straight-moving condition. When the vehicle is in a straight-moving condition, the steering angle of each wheel of the vehicle is 0°, and the value of the turning resistance in the longitudinal direction of the vehicle is zero. It can be seen that any of the methods for determining vehicle mass provided in the above embodiments of the present application is applicable to both straight-moving conditions and turning conditions. In addition, using the least squares identification model to determine the vehicle mass can avoid the influence of external interference and sensor signal mutations on the accuracy of determining the vehicle mass, thereby improving the precision, accuracy and robustness of determining the vehicle mass.
[0129] Before the electronic device determines the mass of the vehicle using the longitudinal dynamics model provided in the embodiment of the present application, it is also necessary to obtain in advance the slope of the road on which the vehicle is located. Different from the existing method of jointly identifying the mass of the vehicle and the road slope, the method for determining the mass of the vehicle provided in the present application is also a method for determining the mass of the vehicle by decoupling the mass of the vehicle from the road slope. In addition, the present application also provides a method for determining the road slope. The method for determining the road slope provided in the present application is introduced as follows.
[0130] Example 1:
[0131] First, the vehicle-mounted sensors may include a longitudinal acceleration sensor and a longitudinal velocity sensor, which respectively collect the longitudinal acceleration a(t) and longitudinal velocity u(t) of the vehicle. The longitudinal acceleration signal collected by the longitudinal acceleration sensor is the measured value of the longitudinal acceleration, so the measured value of the longitudinal acceleration is actually the real value of the longitudinal acceleration and the coupled signal of the road slope.
[0132] According to the dynamic model of the longitudinal acceleration sensor, Where g is the acceleration due to gravity, θ is the road slope, It is the time derivative of the longitudinal velocity and also the true value of the longitudinal acceleration.
[0133] Based on the collected longitudinal acceleration measurements, longitudinal velocity, and the dynamic model of the longitudinal acceleration sensor, the electronic device can determine the road slope as
[0134] The electronic device determines the mass of the vehicle using the road surface slope θ determined by the above method and the method for determining the vehicle mass provided in the above embodiment, thereby realizing decoupling identification of the road surface slope and the whole vehicle mass.
[0135] Furthermore, the road slope value θ(t) at time t determined by the above process is used to estimate the slope value at time t+1. For example, the road slope at time t+1 can be estimated using the Kalman algorithm, the least squares identification model can be used to estimate the road slope at time t+1, or the neural network model can be used to predict the road slope at time t+1.
[0136] Example 2:
[0137] The present application also provides a road surface slope determination method for resisting the influence of external interference or sensor signal mutation on road surface slope accuracy, thereby improving road surface slope accuracy and precision.
[0138] like Fig.12 As shown, the method comprises the following steps:
[0139] S1201, obtaining longitudinal acceleration and longitudinal velocity.
[0140] The vehicle sensor module can measure the vehicle's longitudinal acceleration a(t) and longitudinal velocity u(t) to determine the road slope.
[0141] S1202: De-noising the longitudinal acceleration and longitudinal velocity.
[0142] The electronic device can denoise the longitudinal acceleration a(t) and the longitudinal velocity u(t) through a denoising circuit. After the electronic device inputs the longitudinal acceleration a(t) signal into the denoising circuit, the output signal is a(t)′, which is also the time derivative of the longitudinal acceleration a(t). After the electronic device inputs the longitudinal velocity u(t) into the denoising circuit, the output signal is It is also the time derivative of the true value of the longitudinal acceleration. The dynamic model of the longitudinal acceleration sensor can be configured as
[0143] S1203: Determine a second value according to the denoised longitudinal acceleration, the denoised longitudinal speed, and the slope determined last time.
[0144] In a specific implementation, the second value is used to represent the estimated value of the road slope at time t determined by the electronic device through prediction or estimation.
[0145] Electronic devices can use the Kalman filtering method to use the denoised longitudinal acceleration a(t)′ and the denoised longitudinal velocity And the last (most recent) determined slope sinθ(t-1)′, estimate the road slope at time t.
[0146] Electronic devices can also use the denoised longitudinal acceleration a(t)′ and denoised longitudinal velocity a(t)′ through a trained neural network model. And the slope sinθ(t-1)′ determined last time is used to predict the road slope at time t.
[0147] Electronic devices can also use the recursive least squares identification model with a forgetting factor, the denoised longitudinal acceleration a(t)′, and the denoised longitudinal velocity The road surface slope is determined using the slope sinθ(t-1)′ determined last time.
[0148] Specifically, the least squares identification model with a forgetting factor for determining the road slope provided by the present application is specifically shown as follows:
[0149]
[0150] in, is the identification quantity, x θ is the observed quantity, y θ is the output, K θ is the gain vector, P θ is the covariance, λ θ is the forgetting factor. θ Configuration is 1, output y θ (t) is configured as Forgetting factor λ θ It is usually configured to any value between 0.9 and 1. In practice, electronic devices can use the least squares identification model with a forgetting factor to continuously iterate themselves. θ It can be configured as a fixed value, or the forgetting factor λ can be dynamically adjusted according to other sampled data. θ .
[0151] The electronic device uses the de-noised longitudinal acceleration signal a(t)′ and the de-noised longitudinal velocity signal a(t)′ to generate a signal. As well as the identification value obtained when the road slope was most recently determined in the least squares identification model, the road slope of the road where the vehicle is located at time t can be determined.
[0152] In the method for determining the road slope provided by the present application, according to the longitudinal acceleration signal collected by the longitudinal acceleration sensor and the longitudinal velocity signal collected by the longitudinal velocity sensor, a denoising circuit is used to denoise the collected longitudinal acceleration signal and the collected longitudinal velocity signal, so as to effectively suppress signal mutation and external interference. The road slope is determined by a least squares identification model with a forgetting factor, so as to improve the robustness of determining the road slope and the identification accuracy of the road slope.
[0153] In order to avoid abnormal road slope due to sensor abnormality or other reasons, the electronic device further determines the road slope. Compare with the slope threshold. For ease of description, the road slope calculated by the electronic device is Recorded as the second value, the slope threshold is recorded as θ max Among them, θ max It is usually determined based on the maximum road slope allowed by the road design specifications. The electronic device can also perform the following steps when determining the road slope:
[0154] S1204, determine whether the absolute value of the second value is less than the slope threshold, if so, execute step S1205 next, if not, execute step S1206 next.
[0155] The absolute value of the second value and the maximum road slope θ max For comparison, if Less than θ max , indicating that the electronic device estimated that there was no abnormality in the road slope at time t. It can be used to determine the vehicle mass at time t, or to determine the relevant parameters for vehicle control. Less than θ max , the next step is to execute step S1205. Greater than or equal to θ max , indicating that the electronic device estimates that the road slope at time t may be abnormal, that is, it exceeds the maximum road slope allowed in the conventional road design specifications, and the next step is to execute step S1206.
[0156] S1205: Determine the second value as the road surface slope.
[0157] S1206, determine whether the second value is less than zero, if so, execute step S1207 next, if not, execute step S1208 next.
[0158] if Greater than or equal to θ max , the maximum road slope θ max As the final return value of the road slope (used to determine the slope of the vehicle mass), the sign of the final return value is consistent with the sign of the second value. If the second value is less than zero, that is, the sign of the second value is negative, the next step is to execute step S1207. On the contrary, if the second value is greater than zero, that is, the sign of the second value is positive, the corresponding step is to execute step S1208.
[0159] S1207: Determine the opposite of the slope threshold as the road surface slope.
[0160] S1208: Determine the road surface slope threshold as the road surface slope.
[0161] Compared with the existing method for determining the road surface slope, the method for determining the road surface slope provided in the embodiment of the present application does not require the addition of other hardware structures. The longitudinal acceleration and longitudinal velocity are respectively collected by conventional vehicle sensors such as a longitudinal acceleration sensor and a longitudinal velocity sensor. The accuracy and precision of determining the road surface slope can be improved without increasing the cost. The method for determining the road surface slope provided in the embodiment of the present application can achieve the decoupling of the road surface slope and the vehicle mass, so that the determination of the road surface slope is not affected by the vehicle mass or the turning condition. In addition, the method for determining the road surface slope provided in the embodiment of the present application is applicable to both straight-ahead conditions and turning conditions.
[0162] The method for determining vehicle mass provided in the embodiment of the present application can achieve the decoupling of vehicle mass, road slope and turning resistance, and can improve the precision and accuracy of determining vehicle mass. The method for determining vehicle mass provided in the embodiment of the present application is applicable to both turning conditions and execution conditions, and can adapt to complex and changeable driving conditions.
[0163] It should be noted that the method for determining the mass of the entire vehicle and the method for determining the road slope provided in the embodiments of the present application can be implemented as independent solutions respectively, or they can be implemented in combination as a solution, and the present application does not make any specific limitations.
[0164] Based on the same concept, the embodiment of the present application also provides a vehicle mass determination device 1300 for implementing Figures 4 to 12 The method described in the embodiment, the structure of the device is as follows Fig.13 As shown, it includes: a collection module 1301 and a processing module 1302.
[0165] The acquisition module 1301 is used to obtain a parameter set of the vehicle at a first moment, wherein the parameter set includes: a steering angle, a lateral velocity, a yaw angular velocity, a longitudinal force and a lateral force of each wheel in the vehicle, and the parameter set is used to determine a turning resistance of the vehicle;
[0166] The processing module 1302 is used to determine the mass of the vehicle according to the parameter set and the longitudinal dynamics model, wherein the longitudinal dynamics model is used to describe the longitudinal force balance of the vehicle, and the longitudinal force of the vehicle includes the turning resistance.
[0167] In one implementation, if the vehicle includes two steering wheels, the turning resistance and the parameter set satisfy the following formula:
[0168]
[0169] Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β iis the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw angular velocity of the vehicle.
[0170] In one implementation, if the vehicle includes four steering wheels, the turning resistance and the parameter set satisfy the following formula:
[0171]
[0172] Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw rate of the vehicle, where F y1 、F y2 The angles formed between the directions of the longitudinal velocity direction are greater than 90°, F y3 、F y4 The angles formed between the directions and the longitudinal speed direction are less than 90°.
[0173] In one implementation, the processing module 1302 is further used to: after determining the mass of the vehicle according to the parameter set and the longitudinal dynamics model, determine the mass of the vehicle at a second moment according to the mass, wherein the second moment is after the first moment.
[0174] In one implementation, the processing module 1302 may be specifically used to: obtain a first parameter set and a second parameter set of the vehicle at the second moment, the first parameter set including: road slope, longitudinal speed, lateral speed and yaw rate, the second parameter set including: steering angle, lateral speed, yaw rate, longitudinal force and lateral force of each wheel, driving force and air resistance of each wheel in the vehicle. Determine a first input value, the first input value is determined according to a preset rolling friction parameter, a preset rotational mass conversion coefficient and the first parameter set. Determine a second input value, the second input value is determined according to the second parameter set. Determine a first value according to the first input value, the second input value and the mass of the vehicle at the first moment, the first value is an estimated value of the mass of the vehicle at the second moment; determine the mass of the vehicle at the second moment according to the first value and the first mass threshold and the second mass threshold.
[0175] In one implementation, the processing module 1302 may be specifically configured to: if the first value is less than or equal to the first mass threshold, determine the first mass threshold as the vehicle mass at the second moment. Alternatively, if the first value is greater than or equal to the second mass threshold, determine the second mass threshold as the vehicle mass at the second moment. Alternatively, if the first value is greater than the first mass threshold and the first value is less than the second mass threshold, determine the first value as the vehicle mass at the second moment.
[0176] In one implementation, the longitudinal force of the vehicle also includes the slope resistance of the vehicle; the processing module 1302 may also be used to: determine the slope of the road where the vehicle is located at the first moment, the slope being used to determine the slope resistance;
[0177] When determining the first mass of the vehicle according to the parameter set and the longitudinal dynamics model, the processing module 1302 is specifically configured to determine the mass of the vehicle according to the parameter set, the slope and the longitudinal dynamics model.
[0178] In one implementation, the processing module 1302 may be specifically used to: obtain a longitudinal acceleration signal and a longitudinal velocity signal of the vehicle at the first moment; denoise the longitudinal acceleration signal and the longitudinal velocity signal; determine a second value based on the denoised longitudinal acceleration signal, the denoised longitudinal velocity signal and the slope determined last time; and determine the slope of the road where the vehicle is located at the first moment based on the second value and a slope threshold.
[0179] In one implementation, the processing module 1302 may be specifically configured to: if the absolute value of the second value is less than the slope threshold, determine the second value as the slope of the road where the vehicle is located at the first moment. Alternatively, if the absolute value of the second value is greater than or equal to the slope threshold, and the second value is less than zero, determine the opposite of the slope threshold as the slope of the road where the vehicle is located at the first moment. Alternatively, if the absolute value of the second value is greater than or equal to the slope threshold, and the second value is greater than zero, determine the slope threshold as the slope of the road where the vehicle is located at the first moment.
[0180] The division of modules in the embodiments of the present application is schematic and is only a logical function division. There may be other division methods in actual implementation. In addition, each functional module in each embodiment of the present application may be integrated into a processor, or may exist physically separately, or two or more modules may be integrated into one module. The above-mentioned integrated modules may be implemented in the form of hardware or in the form of software functional modules.
[0181] Among them, the integrated module can be implemented in the form of hardware, such as Fig.14 As shown, the vehicle control device may include a processor 1401. The hardware of the entity corresponding to the above module may be the processor 1401. The processor 1401 may be a central processing unit (CPU), or a digital processing module, etc. The device also includes: a memory 1402, which is used to store the program executed by the processor 1401. The memory 1402 may be a non-volatile memory, such as a hard disk drive (HDD) or a solid-state drive (SSD), etc., or a volatile memory (volatile memory), such as a random-access memory (RAM). The memory 1402 is any other medium that can be used to carry or store the desired program code in the form of instructions or data structures and can be accessed by a computer, but is not limited to this. The device may also include a communication interface 1403 and a communication interface 1404. The processor 1401 may obtain actual yaw angular velocity, longitudinal velocity, longitudinal acceleration, lateral acceleration and other parameters collected by the vehicle-mounted sensor through the communication interface 1403, and obtain parameters such as steering wheel angle from the driver input device through the communication interface 1404.
[0182] In one implementation, the processor 1401 is used to execute the program code stored in the memory 1402, specifically to execute Figures 4 to 12 The method described in the embodiment described above. Figures 4 to 12The method described in the embodiment shown in the figure will not be described in detail in this application. In this implementation, the processor 1401 can implement the program code stored in the memory 1402 by executing the program code stored in the memory 1402. Fig.14 The functionality of device 1200 for determining vehicle mass is shown.
[0183] In another implementation, the processor 1401 is used to execute the program code stored in the memory 1402, which can be used to execute Figure 4 The method described in step S401 and step S402 in FIG. Figure 4 The method described in the embodiment shown in the figure will not be described in detail in this application. In this implementation, the processor 1401 can implement the program code stored in the memory 1402 by executing the program code stored in the memory 1402. Figure 2 , Figure 3 The functions of the vehicle systems shown can also be implemented Fig.14 The function of the device for determining the vehicle mass is shown.
[0184] The specific connection medium between the processor 1401, the memory 1402, the communication interface 1403, and the communication interface 1404 is not limited in the embodiment of the present application. Fig.14 In the embodiment, the processor 1401, the memory 1402, the communication interface 1403 and the communication interface 1404 are connected via a bus 1405. Fig.14 The connections between the other components are shown in bold lines, which are only for illustration and are not intended to be limiting. The bus can be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Fig.14 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.
[0185] An embodiment of the present application also provides a computer-readable storage medium for storing computer software instructions required to be executed by the above-mentioned processor, which includes a program required to be executed by the above-mentioned processor.
[0186] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented in one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that include computer-usable program code.
[0187] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0188] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.
[0189] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.
[0190] Obviously, those skilled in the art can make various changes and modifications to the present application without departing from the spirit and scope of the present application. Thus, if these modifications and variations of the present application fall within the scope of the claims of the present application and their equivalents, the present application is also intended to include these modifications and variations.
Claims
1. A method for determining vehicle mass, characterized in that: The method comprises: Acquire a parameter set of the vehicle at a first moment, the parameter set comprising: a steering angle, a lateral velocity, a yaw angular velocity, a longitudinal force and a lateral force of each wheel in the vehicle, the parameter set being used to determine a turning resistance of the vehicle; The mass of the vehicle is determined based on the parameter set and the longitudinal dynamics model, wherein the longitudinal dynamics model includes turning resistance and one or more of the following: acceleration resistance, air resistance, rolling resistance, slope resistance, driving force, and braking force, and the longitudinal dynamics model is used to describe the longitudinal force balance of the vehicle, and the longitudinal force of the vehicle includes the turning resistance.
2. The method according to claim 1, characterized in that If the vehicle includes two steering wheels, the turning resistance and the parameter set satisfy the following formula: Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw angular velocity of the vehicle.
3. The method according to claim 1, characterized in that If the vehicle includes four steering wheels, the turning resistance and the parameter set satisfy the following formula: Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw rate of the vehicle, where F y1 、F y2 The angles formed between the directions of the longitudinal velocity and the longitudinal velocity direction are greater than 90°, F y3 、F y4 The angles formed between the directions and the longitudinal speed direction are less than 90°.
4. The method according to any one of claims 1 to 3, characterized in that After determining the mass of the vehicle according to the parameter set and the longitudinal dynamics model, the method further includes: A mass of the vehicle at a second time is determined based on the mass, wherein the second time is after the first time.
5. The method according to claim 4, characterized in that Determining the mass of the vehicle at a second moment according to the mass includes: Acquire a first parameter set and a second parameter set of the vehicle at the second moment, wherein the first parameter set includes: road slope, longitudinal speed, lateral speed, and yaw rate, and the second parameter set includes: steering angle, lateral speed, yaw rate, longitudinal force and lateral force of each wheel, driving force, and air resistance of each wheel in the vehicle; Determining a first input value, wherein the first input value is determined according to a preset rolling friction parameter, a preset rotational mass conversion coefficient, and the first parameter set; determining a second input value, wherein the second input value is determined according to the second parameter set; Determine a first value according to the first input value, the second input value, and the mass of the vehicle at the first moment, wherein the first value is an estimated value of the mass of the vehicle at the second moment; The mass of the vehicle at the second moment is determined according to the first value and a first mass threshold and a second mass threshold.
6. The method according to claim 5, characterized in that The determining the vehicle mass at the second moment according to the first value includes: If the first value is less than or equal to the first mass threshold, the first mass threshold is determined as the vehicle mass at the second moment; or, If the first value is greater than or equal to the second mass threshold, the second mass threshold is determined as the vehicle mass at the second moment; or, If the first value is greater than the first mass threshold and the first value is less than the second mass threshold, the first value is determined as the vehicle mass at the second moment.
7. The method according to any one of claims 1 to 3, characterized in that The longitudinal force of the vehicle also includes the slope resistance of the vehicle; The method further comprises: Determining the slope of the road on which the vehicle is located at the first moment, wherein the slope is used to determine the slope resistance; Determining the first mass of the vehicle according to the parameter set and the longitudinal dynamics model includes: The mass of the vehicle is determined based on the parameter set, the slope, and the longitudinal dynamics model.
8. The method according to claim 7, characterized in that The determining the slope of the road on which the vehicle is located at the first moment includes: Acquiring a longitudinal acceleration signal and a longitudinal velocity signal of the vehicle at the first moment; De-noising the longitudinal acceleration signal and the longitudinal velocity signal; Determine a second value according to the denoised longitudinal acceleration signal, the denoised longitudinal velocity signal and the slope determined last time, wherein the second value is an estimated value of the road surface slope at the first moment; The slope of the road on which the vehicle is located at the first moment is determined according to the second value and the slope threshold.
9. The method according to claim 8, characterized in that Determining the slope of the road surface on which the vehicle is located at the first moment according to the second value includes: If the absolute value of the second value is less than the slope threshold, the second value is determined as the slope of the road where the vehicle is located at the first moment; or, If the absolute value of the second value is greater than or equal to the slope threshold, and the second value is less than zero, the inverse of the slope threshold is determined as the slope of the road where the vehicle is located at the first moment; or, If the absolute value of the second value is greater than or equal to the slope threshold, and the second value is greater than zero, the slope threshold is determined as the slope of the road where the vehicle is located at the first moment.
10. A device for determining vehicle mass, characterized in that: The device comprises: A collection module, used to obtain a parameter set of the vehicle at a first moment, the parameter set including: a steering angle, a lateral velocity, a yaw angular velocity, a longitudinal force and a lateral force of each wheel in the vehicle, the parameter set being used to determine a turning resistance of the vehicle; A processing module is used to determine the mass of the vehicle based on the parameter set and a longitudinal dynamics model, wherein the longitudinal dynamics model includes turning resistance and one or more of the following: acceleration resistance, air resistance, rolling resistance, slope resistance, driving force, and braking force, and the longitudinal dynamics model is used to describe the longitudinal force balance of the vehicle, and the longitudinal force of the vehicle includes the turning resistance.
11. The device according to claim 10, characterized in that If the vehicle includes two steering wheels, the turning resistance and the parameter set satisfy the following formula: Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw angular velocity of the vehicle.
12. The device according to claim 10, characterized in that If the vehicle includes four steering wheels, the turning resistance and the parameter set satisfy the following formula: Among them, F r is the turning resistance of the vehicle, m is the mass of the vehicle, β i is the steering angle of the i-th steering wheel of the vehicle, n is the number of steering wheels of the vehicle, F xi is the longitudinal force of the i-th steering wheel of the vehicle, F yi is the lateral force of the i-th steering wheel of the vehicle, v is the lateral speed of the vehicle, w r is the yaw rate of the vehicle, where F y1 、F y2 The angles formed between the directions of the longitudinal velocity and the longitudinal velocity direction are greater than 90°, F y3 、F y4 The angles formed between the directions and the longitudinal speed direction are less than 90°.
13. The device according to any one of claims 10 to 12, characterized in that The processing module is also used for: After determining the mass of the vehicle according to the parameter set and the longitudinal dynamics model, determining the mass of the vehicle at a second time according to the mass, wherein the second time is after the first time.
14. The device according to claim 13, characterized in that The processing module is specifically used for: Acquire a first parameter set and a second parameter set of the vehicle at the second moment, wherein the first parameter set includes: road slope, longitudinal speed, lateral speed, and yaw rate, and the second parameter set includes: steering angle, lateral speed, yaw rate, longitudinal force and lateral force of each wheel, driving force, and air resistance of each wheel in the vehicle; Determining a first input value, wherein the first input value is determined according to a preset rolling friction parameter, a preset rotational mass conversion coefficient, and the first parameter set; determining a second input value, wherein the second input value is determined according to the second parameter set; Determine a first value according to the first input value, the second input value, and the mass of the vehicle at the first moment, wherein the first value is an estimated value of the mass of the vehicle at the second moment; The mass of the vehicle at the second moment is determined according to the first value and a first mass threshold and a second mass threshold.
15. The device according to claim 14, characterized in that The processing module is specifically used for: If the first value is less than or equal to the first mass threshold, the first mass threshold is determined as the vehicle mass at the second moment; or, If the first value is greater than or equal to the second mass threshold, determining the second mass threshold as the vehicle mass at the second moment; or, If the first value is greater than the first mass threshold and the first value is less than the second mass threshold, the first value is determined as the vehicle mass at the second moment.
16. The device according to any one of claims 10 to 12, characterized in that The longitudinal force of the vehicle also includes the slope resistance of the vehicle; The processing module is further used to: determine the slope of the road where the vehicle is located at the first moment, and the slope is used to determine the slope resistance; When determining the first mass of the vehicle according to the parameter set and the longitudinal dynamics model, the processing module is specifically used to: determine the mass of the vehicle according to the parameter set, the slope and the longitudinal dynamics model.
17. The device according to claim 16, characterized in that The processing module is specifically used for: Acquiring a longitudinal acceleration signal and a longitudinal velocity signal of the vehicle at the first moment; De-noising the longitudinal acceleration signal and the longitudinal velocity signal; Determine a second value according to the denoised longitudinal acceleration signal, the denoised longitudinal velocity signal and the slope determined last time, wherein the second value is an estimated value of the road surface slope at the first moment; The slope of the road on which the vehicle is located at the first moment is determined according to the second value and the slope threshold.
18. The device according to claim 17, characterized in that The processing module is specifically used for: If the absolute value of the second value is less than the slope threshold, the second value is determined as the slope of the road where the vehicle is located at the first moment; or, If the absolute value of the second value is greater than or equal to the slope threshold, and the second value is less than zero, the inverse of the slope threshold is determined as the slope of the road where the vehicle is located at the first moment; or, If the absolute value of the second value is greater than or equal to the slope threshold, and the second value is greater than zero, the slope threshold is determined as the slope of the road where the vehicle is located at the first moment.
19. An electronic device, characterized in that: The electronic device comprises a processor and a memory, wherein the memory is used to store computer program instructions. When the processor executes the computer program instructions, the electronic device executes the method for determining the vehicle mass according to any one of claims 1 to 9.
20. A computer-readable storage medium, characterized in that: The computer-readable storage medium includes computer instructions. When the computer instructions are executed on a computer, the computer is enabled to execute the method for determining vehicle mass according to any one of claims 1 to 9.
21. A chip, characterized in that: The method comprises a processor, and when the processor executes instructions, the processor performs the method for determining vehicle mass according to any one of claims 1 to 9.
Citation Information
Patent Citations
Speed change control method for automatic transmission for vehicle
JP1992285364A
Turning behavior controller for vehicle
JP2008068815A
