Apparatus and method for estimating inclination of vehicle
By correcting for interference in the longitudinal acceleration sensor values when the vehicle is stationary and using a Kalman filter to estimate the vehicle tilt angle, the problem of inaccurate tilt angle estimation when the vehicle is stationary is solved, thus improving the reliability and accuracy of the vehicle control system.
Patent Information
- Application Number
- CN202311400982.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2023-05-11
- Filing Date
- 2023-10-26
- Publication Date
- 2024-11-12
AI Technical Summary
In the prior art, the longitudinal acceleration sensor values of a vehicle are easily affected by vibration and noise, resulting in inaccurate estimation of vehicle tilt angle, especially when the vehicle is stationary and it is difficult to update the tilt angle value.
Driving information is collected by a vehicle information receiver, a vehicle stop detector is used to determine whether the vehicle meets the stopping conditions, an interference corrector corrects the interference of the longitudinal acceleration sensor value, and a Kalman filter is used to estimate the vehicle tilt angle by combining the lateral vehicle speed and yaw rate. Different Q gains are set to reduce the impact of noise.
It effectively corrects interference from longitudinal acceleration sensor values when the vehicle is stationary, improving the reliability and accuracy of tilt estimation and ensuring the reliable operation of vehicle control systems such as traction control systems and cruise control systems.
Smart Images

Figure CN118928427A_ABST
Abstract
Description
[0001] CROSS-REFERENCE TO RELATED APPLICATIONS
[0002] This application claims priority to Korean Patent Application No. 10-2023-0061224, filed on May 11, 2023, which is incorporated herein by this reference in its entirety for all purposes. Technical Field
[0003] The present disclosure relates to a vehicle inclination estimation device and method. Background Art
[0004] The inclination of the vehicle or the inclination of the road can be used as an important factor in vehicle control. For example, when the vehicle stops on a slope, the vehicle can be held with appropriate brake pressure, and when the vehicle starts from the slope, appropriate engine torque can be applied. In addition, in the case of a cruise control system as a function of driving a vehicle at a constant speed, unless the inclination of the road surface is determined in advance, the speed of the vehicle may change as long as the inclination of the road surface changes.
[0005] In order to measure the inclination of the road, a method of directly extracting the inclination of the road surface by attaching a sensor for measuring the inclination, such as a level, a gravity sensor, etc., to the vehicle can be used. However, the level is expensive, which not only increases the price of the vehicle, but also has a significant disadvantage in controlling other actuators due to the slow response of the sensor. In addition, when using a gravity sensor, in addition to the inclination of the road surface, there may also be noise factors such as road impact, resulting in serious errors.
[0006] The information disclosed in this Background section is only for enhancement of understanding of the general background of the invention and should not be regarded as an admission or any form of suggestion that this information constitutes the prior art already known to a person skilled in the art. Summary of the invention
[0007] Aspects of the present disclosure are directed to providing a method of estimating an inclination of a vehicle or a road by detecting a motion of the vehicle and modeling and calculating the detected motion of the vehicle.
[0008] In the method of estimating the inclination by modeling, a longitudinal acceleration sensor value obtained from a longitudinal acceleration sensor may be used. However, in the prior art, interference may occur in the longitudinal acceleration sensor value due to the vibration of the vehicle generated when the vehicle stops after braking, the vibration of the vehicle generated by entering or leaving the vehicle in a stopped state, or the vibration of the vehicle generated by a slipstream generated by the passing of other vehicles.
[0009] Therefore, disturbances present in the longitudinal acceleration sensor values may adversely affect the inclination estimation performance.
[0010] When state-space modeling of the estimated longitudinal acceleration is used, the estimated inclination value may converge to the actual inclination value while the vehicle is operating, such that the estimated inclination value may not be updated when the vehicle is stopped.
[0011] An aspect of the present disclosure provides a vehicle inclination estimation apparatus and method capable of effectively correcting disturbance of a longitudinal acceleration sensor value under a vehicle stop condition.
[0012] Another aspect of the present disclosure provides a vehicle inclination estimation device and method, which can improve the reliability of estimating the inclination of a vehicle during a process of stopping the vehicle.
[0013] Still another aspect of the present disclosure provides a vehicle inclination estimating apparatus and method capable of estimating the inclination of a vehicle even when the vehicle is stopped.
[0014] According to one aspect of the present disclosure, a vehicle inclination estimation device is provided, which includes: a vehicle information receiver, configured to collect driving information of the vehicle, the driving information including wheel speed, driving torque and longitudinal acceleration sensor value; a vehicle stop determiner, configured to determine whether the vehicle meets the vehicle stop condition based on the driving information received from the vehicle information receiver; an interference corrector, configured to correct the interference of the longitudinal acceleration sensor value according to whether the vehicle stop condition is met; and an inclination estimator, configured to estimate the inclination of the vehicle using the longitudinal acceleration input value corrected by the interference corrector.
[0015] In an exemplary embodiment, the vehicle stop condition may be set based on the wheel speed received from the vehicle information receiver or based on the wheel speed and driving torque received from the vehicle information receiver.
[0016] In an exemplary embodiment, the disturbance corrector may be configured to set a value obtained by removing or reducing a ratio of the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimator when the vehicle stop condition is satisfied.
[0017] In an exemplary embodiment, the driving information collected by the vehicle information receiver may further include the lateral speed and yaw rate of the vehicle. The inclination estimator may be configured to estimate the inclination of the vehicle by using the lateral speed, yaw rate and longitudinal acceleration sensor value as inputs of the Kalman filter.
[0018] The apparatus according to the exemplary embodiment may further include: a weight setting unit configured to arrange the system error of the Kalman filter, i.e., the Q gain, according to the driving situation based on the vehicle information received from the vehicle information receiver. The weight setting unit may be configured to set the first Q gain when the vehicle stop condition is satisfied, and to set the second Q gain when the condition immediately before the stop corresponding to the situation immediately before the vehicle stops is satisfied.
[0019] In an exemplary embodiment, the interference corrector can be configured to set a value obtained by removing the longitudinal acceleration sensor value or reducing the ratio of the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimator when the vehicle stop condition is met, and to set the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimator when the vehicle stop condition is not met.
[0020] In an exemplary embodiment, a value of the first Q gain may be set to be smaller than a value of the second Q gain.
[0021] In an exemplary embodiment, the weight setting unit may be configured to set the third Q gain when the vehicle speed is within a set range in an anti-lock braking system (ABS) operating state. The value of the second Q gain may be set to be greater than the value of the first Q gain and less than the value of the third Q gain.
[0022] In an exemplary embodiment, the condition of the ABS operating state may include a first ABS condition and a second ABS condition where the vehicle speed is higher than the first ABS condition. The weight setting unit may be configured to set a third Q gain when the first ABS condition is satisfied, and to set a fourth Q gain when the second ABS condition is satisfied. The value of the fourth Q gain may be set to be greater than the value of the third Q gain.
[0023] The apparatus according to an exemplary embodiment may further include: an estimated value initializer configured to initialize the estimated inclination value estimated by the inclination estimator when a preset condition is satisfied. The estimated value initializer may be configured to initialize the estimated inclination value to an inclination corresponding to a longitudinal acceleration sensor value or to an inclination corresponding to a value obtained by processing the longitudinal acceleration sensor value using a low pass filter (LPF) when a vehicle stop condition is satisfied. The initialized estimated inclination value may be input to the inclination estimator.
[0024] In an exemplary embodiment, the estimated value initializer may be configured to process the longitudinal acceleration sensor value using the LPF when a low speed condition in which the vehicle speed has a preset value or less is satisfied.
[0025] In an exemplary embodiment, the estimated value initializer may be configured to initialize the estimated inclination value to an inclination corresponding to the longitudinal acceleration sensor value when a condition immediately before stopping is satisfied. The initialized estimated inclination value may be input to the inclination estimator.
[0026] In an exemplary embodiment, the estimated tilt value initialized by the estimated value initializer may be input to the interference corrector and used for interference correction.
[0027] According to another aspect of the present disclosure, a vehicle inclination estimation method is provided, the method comprising: a vehicle information receiving operation, receiving driving information of the vehicle, the driving information including wheel speed, driving torque and longitudinal acceleration sensor value; an interference correction operation, judging whether the vehicle satisfies a vehicle stop condition based on the driving information, and correcting interference of the longitudinal acceleration sensor value according to whether the vehicle satisfies the vehicle stop condition; and an inclination estimation operation, estimating the inclination of the vehicle using the longitudinal acceleration input value corrected in the interference correction operation.
[0028] In an exemplary embodiment, the interference correction operation may include setting a value obtained by removing the longitudinal acceleration sensor value or reducing the ratio of the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimation operation when the vehicle stop condition is satisfied.
[0029] The driving information received in the vehicle information receiving operation may further include the lateral speed and yaw rate of the vehicle. The inclination estimating operation may include estimating the inclination of the vehicle by using the lateral speed, yaw rate and longitudinal acceleration sensor value as inputs of the Kalman filter.
[0030] The method according to an exemplary embodiment may further include: a weight setting operation, based on the vehicle information, arranging the system error of the Kalman filter, i.e., the Q gain, according to the driving situation. The weight setting operation may include setting a first Q gain when the vehicle stop condition is satisfied, and setting a second Q gain when the condition immediately before the stop corresponding to the situation immediately before the vehicle stops is satisfied. The value of the first Q gain may be set to be smaller than the value of the second Q gain.
[0031] The method according to an exemplary embodiment may further include: an estimated value initialization operation of initializing an estimated inclination value estimated in the inclination estimation operation when a preset condition is satisfied. The estimated value initialization operation may include initializing the estimated inclination value to an inclination corresponding to a longitudinal acceleration sensor value or an inclination corresponding to a value obtained by processing the longitudinal acceleration sensor value using a low pass filter (LPF) when a vehicle stop condition is satisfied. The initialized estimated inclination value may be input to the inclination estimation operation.
[0032] In an exemplary embodiment, the estimated value initialization operation may include initializing the estimated inclination value to an inclination corresponding to the longitudinal acceleration sensor value when a condition immediately before stopping is satisfied. The initialized estimated inclination value may be input to the inclination estimation operation.
[0033] According to another aspect of the present disclosure, a computer-readable storage medium is provided, recording a program for executing the above-mentioned method on a computer.
[0034] According to the exemplary embodiment of the present disclosure having such a configuration, it is possible to effectively correct the disturbance of the longitudinal acceleration sensor value under the vehicle stop condition.
[0035] In addition, according to the exemplary embodiments of the present disclosure, the reliability of estimating the inclination of the vehicle in the process of stopping the vehicle can be improved.
[0036] In addition, according to the exemplary embodiment of the present disclosure, the inclination of the vehicle may be estimated even when the vehicle is stopped.
[0037] In addition, according to exemplary embodiments of the present disclosure, the reliability of vehicle control such as traction control system (TCS), idle start stop (ISG), cruise control system, brake hold, etc. may be improved.
[0038] The method and apparatus of the present invention have other features and advantages which will be apparent from or set forth in more detail in the accompanying drawings and the following detailed description, which together serve to illustrate certain principles of the invention and are incorporated herein. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] Figure 1 is a schematic diagram illustrating a vehicle inclination estimating apparatus according to an exemplary embodiment of the present disclosure.
[0040] Figure 2 is a schematic diagram showing the forces acting on a vehicle traveling on a slope.
[0041] Figure 3 is a flowchart illustrating a vehicle inclination estimating method according to an exemplary embodiment of the present disclosure.
[0042] Figure 4 It is shown Figure 3 Flowchart of the weight setting operation shown.
[0043] Figure 5 It is shown Figure 3 A flow chart of the interference correction operation is shown.
[0044] Figure 6 It is shown Figure 3 Flowchart of the estimate initialization operation shown.
[0045] Figure 7 is a graph showing a change in inclination over time for explaining the inclination estimation method according to the example and the comparative example.
[0046] Figure 8 is a block diagram of a computer device that can fully or partially implement a vehicle inclination estimation method according to an exemplary embodiment of the present disclosure.
[0047] It should be understood that the drawings are not necessarily drawn to scale, but rather present slightly simplified representations of various features illustrating the basic principles of the invention. Specific design features of the present invention disclosed herein, such as specific size, orientation, location, and shape, will be determined in part by the specific intended application and use environment.
[0048] In the drawings, reference numbers refer to the same or equivalent parts of the present invention throughout the several figures of the drawing. DETAILED DESCRIPTION
[0049] Reference will now be made in detail to various embodiments of the present invention, examples of which are shown in the accompanying drawings and described below. Although the present invention will be described in conjunction with the exemplary embodiments of the present disclosure, it will be understood that this description is not intended to limit the present invention to these exemplary embodiments. On the contrary, the present invention is intended to cover not only the exemplary embodiments of the present disclosure, but also various alternatives, modifications, equivalents and other embodiments that may be included within the thought and scope of the present invention as defined by the appended claims.
[0050] Hereinafter, exemplary embodiments of the present disclosure will be described with reference to the accompanying drawings. However, the present disclosure may be exemplified in many different forms and should not be construed as limited to the specific exemplary embodiments set forth herein.
[0051] As used herein, the singular forms "a", "an" and "the" are intended to include the plural forms as well, unless the context clearly indicates otherwise. Throughout the specification, the same reference numerals or reference numerals assigned in a similar manner refer to the same or corresponding components. In addition, the shapes and sizes of the components in the drawings may be exaggerated for clarity of description.
[0052] As used herein, a vehicle refers to various vehicles that transport objects such as people, animals or objects from a starting point to a destination. These vehicles are not limited to vehicles that travel on roads or tracks.
[0053] Terms such as first, second, A, B, (a), (b), etc. may be used herein to describe components. However, these terms do not limit the order, size, importance, etc. of the components, but are only used to distinguish one component from another.
[0054] Figure 1 is a schematic diagram illustrating a vehicle inclination estimating apparatus 100 according to an exemplary embodiment of the present disclosure.
[0055] Reference Figure 1 , the vehicle inclination estimation device 100 may include: a vehicle information receiver 110 and; and a controller, i.e., a computing device, including a vehicle stop determiner 121, an interference corrector 122, and an inclination estimator 125. In addition, the vehicle inclination estimation device 100 according to the exemplary embodiment may further include a weight setting unit 124 and an estimated value initializer 126. The controller 120 may include at least one of the vehicle stop determiner 121, the interference corrector 122, the inclination estimator 125, the weight setting unit 124, and the estimated value initializer 126.
[0056] The vehicle information receiver 110 may receive driving information measured or calculated by various sensors provided in the vehicle. The vehicle information receiver 110 may directly obtain information from sensors provided in the vehicle (e.g., lateral vehicle speed sensor, yaw rate sensor, wheel speed sensor, acceleration sensor, torque sensor, longitudinal vehicle speed sensor, etc.), or may receive information through a control unit (e.g., vehicle control unit (VCU) etc.) connected to each sensor to collect information. The vehicle information receiver 110 may receive a lateral vehicle speed 111, a yaw rate 112, a wheel speed 113 of each wheel, a longitudinal acceleration 114, a driving torque 115 of the front / rear wheels, and a longitudinal vehicle speed 116 of the vehicle. The longitudinal acceleration 114 may be a value measured by a longitudinal acceleration sensor, and in order to avoid confusion with similar terms, the longitudinal acceleration 114 measured by the longitudinal acceleration sensor may be expressed as a longitudinal acceleration sensor value 114.
[0057] The vehicle stop determiner 121 may determine whether the vehicle satisfies the vehicle stop condition based on the driving information received from the vehicle information receiver 110 .
[0058] The vehicle stop condition may be set based on the wheel speed 113 of the vehicle received from the vehicle information receiver 110. The vehicle stop condition may also be set based on the wheel speed 113 and the driving torque 115 of the vehicle.
[0059] As an example, the vehicle stop condition may be set to a situation where the wheel speed 113 of each of all wheels is less than a first speed (e.g., 0.15 m / s) within a first time period (e.g., 1 second) and the driving torque 115 is not applied to the wheels of the vehicle. However, the vehicle stop condition is not limited thereto and may be changed in various ways in consideration of the performance of the vehicle and the characteristics of various sensors such as a longitudinal acceleration sensor. As used herein, a "vehicle stop condition" may include not only a situation where the vehicle is completely stopped, but also a situation where the vehicle is slightly moving without applying the driving torque 115 to the wheels. For example, a "vehicle stop condition" may include a situation where the vehicle is slightly pushed on a slope.
[0060] The vehicle may vibrate when stopped after braking, and may also be shaken or vibrated by external factors, such as passengers entering or leaving the vehicle or slipstream caused by other vehicles driving nearby.
[0061] Therefore, when the vehicle stop condition is satisfied, disturbance may occur in the longitudinal acceleration sensor value 114. When performing inclination estimation based on the longitudinal acceleration sensor value 114, the disturbance of the longitudinal acceleration sensor value 114 may become noise and adversely affect the inclination estimation performance.
[0062] The interference corrector 122 may correct the interference of the longitudinal acceleration sensor value 114 according to whether the vehicle stop condition is satisfied. That is, in the vehicle stop condition, a large amount of noise may appear in the longitudinal acceleration sensor value 114 due to the vibration or shaking of the vehicle. Therefore, when performing the inclination estimation, the influence of the longitudinal acceleration sensor value 114 may be reduced by correcting the interference of the vehicle stop condition.
[0063] The inclination estimator 125 may estimate the inclination of the vehicle using the longitudinal acceleration input value.
[0064] When a vehicle stops on a road with an inclination angle of α, the longitudinal acceleration of the vehicle under the action of gravity is a x It can be expressed as gsinα. Therefore, the inclination of the vehicle can be estimated by the longitudinal acceleration sensor value 114. The unit of the longitudinal acceleration sensor value 114 can be meter per square second (m / s 2 ), and the unit of the inclination estimated using the longitudinal acceleration sensor value 114 may be the same as the unit of the longitudinal acceleration sensor value 114. For ease of description, in the detailed description and claims, the unit of the inclination is described as being the same as the unit of acceleration, i.e., m / s 2 .
[0065] The inclination of the vehicle may be estimated using the longitudinal acceleration input value corrected by the disturbance corrector 122. The value of the inclination of the vehicle may be substantially the same as or similar to the value of the inclination of the road.
[0066] The inclination estimator 125 may estimate the inclination of the vehicle using the longitudinal acceleration input value corrected by the disturbance corrector 122. When the noise occurring in the longitudinal acceleration sensor under the vehicle stop condition is reduced or eliminated, the reliability of the inclination estimation may be improved and the settling time of the estimated inclination value may be shortened.
[0067] To this end, when the vehicle stop condition is satisfied, the disturbance corrector 122 may set a value obtained by removing the longitudinal acceleration sensor value 114 or a value obtained by reducing the ratio of the longitudinal acceleration sensor value 114 as the longitudinal acceleration input value input to the inclination estimator 125 .
[0068] When the vehicle stop condition is satisfied, the disturbance corrector 122 may consider that the longitudinal acceleration sensor value 114 contains a large amount of noise, exclude the longitudinal acceleration sensor value 114, and set the estimated inclination value estimated in the previous operation (time) as the longitudinal acceleration input value.
[0069] Alternatively, when the vehicle stop condition is satisfied, the interference corrector 122 may set a value obtained by reducing the ratio of the longitudinal acceleration sensor value 114 and increasing the ratio of the estimated inclination value estimated in the previous operation as the longitudinal acceleration input value. For example, when the vehicle stop condition is satisfied, the longitudinal acceleration input value input to the inclination estimator 125 may have a value obtained by setting the ratio of the longitudinal acceleration sensor value 114 to 0.2 and setting the ratio of the estimated inclination value estimated in the previous operation to 0.8.
[0070] In addition, when the vehicle stop condition is not satisfied, the interference corrector 122 may set the longitudinal acceleration sensor value 114 as the longitudinal acceleration input value input to the inclination estimator 125. That is, when the vehicle stop condition is not satisfied, the interference corrector 122 may not perform interference correction on the longitudinal acceleration sensor value 114.
[0071] The inclination estimator 125 can estimate the inclination through a filter, which is configured to model the state space. For example, the inclination estimator 125 can estimate the inclination of the vehicle through a Kalman filter 123. The Kalman filter 123 according to an exemplary embodiment may include an inclination estimator 125, a weight setting unit 124, and an estimated value initializer 126.
[0072] A Kalman filter may be an estimation technique for finding state variables of a system using a probabilistic model of a target system and measurements.
[0073] The Kalman filter may include a prediction process (prediction step) and an estimation process (correction step). Formulas 1 and 2 are related to the prediction process, and Formulas 3 to 5 are related to the estimation process.
[0074] [Formula 1]
[0075]
[0076] [Formula 2]
[0077]
[0078] In Formula 1, "x" may be a state matrix representing the state variables to be optimized by the Kalman filter, and "A" may be a system matrix. "B" may be a control matrix, and "u" may be an input matrix. In Formula 2, "P" may be an error covariance, and "Q" may be a system error (system noise). "k" is an integer, and "T" represents the transpose of a matrix.
[0079] The prediction operation may receive the final estimated value "x" and the error covariance "P" as inputs, and may output predicted values (estimated values) "x" and "P" as final results using the system model variables "A" and "Q". The predicted values "x" and "P" may be used in the estimation process.
[0080] [Formula 3]
[0081]
[0082] [Formula 4]
[0083]
[0084] [Formula 5]
[0085]
[0086] In Formula 3 to Formula 5, "K" may be a Kalman gain, "H" may be a filter model, and "R" may be a sensor error (sensor noise). In Formula 4, "z" may be a measurement value.
[0087] The estimation process may receive predicted values "x" and "P" and measured values "z", and may output estimated values "x" and error covariance "P" using a filter model "H" and sensor error "R".
[0088] The above-mentioned Kalman filter can be used for tilt estimation, which will be described in more detail.
[0089] Figure 2 is a schematic diagram showing forces acting on a vehicle traveling on a slope. The longitudinal direction of the vehicle may correspond to the length direction of the vehicle, the lateral direction of the vehicle may correspond to the left-right direction of the vehicle, and the vertical direction of the vehicle may correspond to the height direction of the vehicle. In addition, the movement of rotation relative to the longitudinal direction of the vehicle may be called roll, the movement of rotation relative to the lateral direction of the vehicle may be called pitch, and the movement of rotation relative to the height direction of the vehicle may be called yaw.
[0090] Reference Figure 2 , the longitudinal acceleration sensor value a detected by the vehicle's longitudinal acceleration sensor x,m It can be obtained using Formula 6.
[0091] [Formula 6]
[0092]
[0093] In Formula 6, “a x " may be the longitudinal acceleration of the vehicle, "g" may be the acceleration due to gravity, "α" may be the inclination angle of the road on which the vehicle is traveling, "θ" may be the pitch angle, and "V y " can be the lateral speed of the vehicle, It can be the yaw rate.
[0094] When Formula 6 is designed as a state space, Formula 6 can be expressed by the following Formulas 7 to 9.
[0095] [Formula 7]
[0096]
[0097] [Formula 8]
[0098]
[0099] [Formula 9]
[0100]
[0101] In Formula 7, can correspond to the system matrix "A" in Formula 1, and It may correspond to the control matrix "B" in Formula 1. In Formula 7 and Formula 8, "x" may be a state matrix. In Formula 7 and Formula 9, "u" may be an input matrix. The input matrix "u" of the Kalman filter may be set to the longitudinal acceleration sensor value a x,m and the lateral speed of the vehicle V y and yaw rate In an exemplary embodiment, the measured value z of the Kalman filter may be the vehicle speed based on the wheel speed, and the predicted value (estimated value) may be the longitudinal acceleration sensor value. The inclination of the vehicle may be estimated based on the predicted (estimated) longitudinal acceleration sensor value.
[0102] In an exemplary embodiment, the driving information used by the Kalman filter 123 may include a wheel speed 113, a longitudinal acceleration sensor value 114, a lateral vehicle speed 111 of the vehicle, and a yaw rate 112 of the vehicle, and the driving information may be received from the vehicle information receiver 110. The inclination estimator 125 may estimate the inclination of the vehicle using the wheel speed 113, the lateral vehicle speed 111, the yaw rate 112, and the longitudinal acceleration sensor value 114 through the Kalman filter 123. The wheel speed 113 may be input to the Kalman filter as a measured value, and the longitudinal acceleration sensor value 114 of the vehicle as well as the lateral vehicle speed 111 and the yaw rate 112 may be input to the Kalman filter as an input matrix. The longitudinal acceleration sensor value 114 may correspond to a predicted value of the Kalman filter.
[0103] The weight setting unit 124 can arrange the system error of the Kalman filter, i.e., the Q gain, according to the driving situation (e.g., vehicle speed, ABS situation, etc.) based on the vehicle information (e.g., wheel speed, longitudinal acceleration sensor value, etc.) received from the vehicle information receiver 110. That is, the weight setting unit 124 can set the value of the Q gain according to the driving situation. Therefore, in the Kalman filter used for the inclination estimator 125, the weights of the measured value (i.e., wheel speed) and the predicted value (i.e., longitudinal acceleration sensor value) can be changed.
[0104] Generally speaking, in the Kalman filter, when the Q gain (Q value) increases, the weight of the measured value (i.e., wheel speed) may increase, while the weight of the predicted value (i.e., longitudinal acceleration sensor value) may decrease. Conversely, when the Q gain (Q value) decreases, the weight of the measured value (i.e., wheel speed) may decrease, while the weight of the predicted value (i.e., longitudinal acceleration sensor value) may increase.
[0105] The weight setting unit 124 may set the first Q gain when the vehicle stop condition is satisfied, and may set the second Q gain when the immediately before stop condition corresponding to the situation immediately before the vehicle stops is satisfied.
[0106] As described above, under the vehicle stop condition, a large amount of noise may appear in the longitudinal acceleration sensor value 114 due to the change in the load movement of the vehicle and / or the vehicle being excited by the spring. When the vehicle stop condition is satisfied, the interference corrector 122 may set a value obtained by removing the longitudinal acceleration sensor value or reducing the ratio of the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimator 125. Therefore, under the vehicle stop condition, the longitudinal acceleration input value input to the inclination estimator 125 may not reflect the longitudinal acceleration sensor value in which the noise appears, or the ratio of the longitudinal acceleration input value input to the inclination estimator 125 may be small. Under the vehicle stop condition, the longitudinal acceleration input value from which the interference is eliminated by the interference corrector 122 may be input to the inclination estimator 125 based on the Kalman filter, so that the reliability of the longitudinal acceleration sensor value (the input value from which the interference is eliminated), that is, the predicted value, may be higher than the reliability of the longitudinal acceleration sensor value before the interference is eliminated.
[0107] Therefore, in order to set the longitudinal acceleration sensor value from which the disturbance is eliminated by the disturbance corrector 122 as the longitudinal acceleration input value and to make the Kalman filter actively use the longitudinal acceleration sensor value (prediction value) from which the disturbance is eliminated, the value of the first Q gain may be reduced.
[0108] When the condition immediately before stopping corresponding to the situation immediately before the vehicle stops is satisfied, the vehicle may not be in a stopped state, so that the possibility of vibration or shaking due to stopping may be small. That is, the condition immediately before stopping may be a state immediately before disturbance occurs in the longitudinal acceleration sensor value, so that the longitudinal acceleration sensor value may have high reliability. Therefore, in order to increase the weight of the longitudinal acceleration sensor value (prediction value) having high reliability, the value of the second Q gain may be reduced.
[0109] The condition immediately before stopping may be a state where the vehicle speed is less than a second speed (e.g., 0.15 m / s) within a time period less than a second time period (e.g., 1 second) and the differential value of the longitudinal acceleration sensor value is less than a preset value (e.g., 0.04). However, the condition immediately before stopping is not limited thereto and may be variously changed in consideration of the performance of the vehicle and the characteristics of various sensors such as the longitudinal acceleration sensor.
[0110] The value of the first Q gain of the vehicle stop condition can be set to a value smaller than the value of the second Q gain of the condition immediately before the stop. In this case, under the vehicle stop condition without wheel speed, the longitudinal acceleration input value from which interference is eliminated can be actively used, and the longitudinal acceleration sensor value (predicted value) can be made to quickly approach the estimated value of the Kalman filter. In addition, the value of the second Q gain can be set to a value greater than the first Q gain, thereby reducing the ratio of the longitudinal acceleration sensor value compared to the vehicle stop condition. Therefore, in the process of changing the estimated inclination value from the condition immediately before the stop to the vehicle stop condition, the rate of change of the estimated inclination value can be reduced.
[0111] The weight setting unit 124 may set the Q gain in an anti-lock braking system (ABS) operating state. For example, when the vehicle speed is within a set range, the weight setting unit 124 may set the third Q gain.
[0112] In the ABS operating state, the rotation of the wheel may be restricted. Therefore, when the wheel speed is input to the Kalman filter, the reliability of the estimated inclination value may be reduced. That is, in the ABS operating state where the rotation of the wheel is restricted, the correction performance of the Kalman filter may be adversely affected. Therefore, a high level of filtering may be required to improve the reliability of the estimated inclination value. In the ABS operating state, the Q gain can be increased to increase the weight of the wheel speed (measured value) and reduce the weight of the predicted value (longitudinal acceleration sensor value). Under the ABS operating condition, the rate of change of the estimated inclination value can be reduced by increasing the Q gain. The value of the third Q gain of the ABS operating condition can be set to be greater than the value of the first Q gain of the vehicle stop condition or the value of the second Q gain of the condition immediately before the stop.
[0113] The ABS operating condition may include a first ABS condition and a second ABS condition where the vehicle speed is higher than the first ABS condition. The weight setting unit 124 may set the third Q gain when the first ABS condition is satisfied, and may set the fourth Q gain when the second ABS condition is satisfied.
[0114] The first ABS condition may correspond to a low-speed ABS condition, and the second ABS condition may correspond to a high-speed ABS condition. The vehicle speed of the second ABS condition may be higher than that of the first ABS condition, thereby further increasing the adverse effect on the correction performance of the Kalman filter compared to the first ABS condition. Therefore, a higher level of filtering may be required to improve the reliability of the estimated inclination value compared to the first ABS condition. In view of this, the value of the fourth Q gain of the second ABS condition may be set to be greater than the value of the third Q gain of the first ABS condition.
[0115] For example, the first ABS condition may be set to a case where the time period elapsed from the time when the ABS control is released is less than a third time period (e.g., 0.8 seconds) and the vehicle speed is lower than a third speed (e.g., 1 m / s). The second ABS condition may be set to a case where the time period elapsed from the time when the ABS control is released is less than a fourth time period (e.g., 0.5 seconds) and the vehicle speed is higher than a fourth speed (e.g., 3 m / s). However, the ABS condition is not limited thereto and may be changed in various ways in consideration of the performance of the vehicle and the characteristics of various sensors, etc. In addition, the condition of the ABS operating state may be set to have only one part or may be divided into three or more parts.
[0116] When a preset condition is satisfied, the estimated value initializer 126 may initialize the estimated inclination value estimated by the inclination estimator 125 .
[0117] The estimation process of the Kalman filter can output a new estimated value using the predicted value (estimated value) and the measured value of the prediction process. Therefore, due to the characteristics of the Kalman filter, the estimated value can converge to the true value only when the system is operating. That is, the system may not be operated in a stopped state, so that the estimated inclination value may not converge to the actual value (true value) of the inclination. When the difference between the estimated inclination value and the actual inclination value increases, when the vehicle stops on a slope, it may not be possible to hold the vehicle with appropriate braking pressure, and when the vehicle starts from a slope, it may not be possible to apply appropriate engine torque.
[0118] In an exemplary embodiment, in order to solve such a problem, when the vehicle stop condition is met, the estimated inclination value of the Kalman filter can be initialized to a preset value. For example, the estimated value initializer 126 can initialize the estimated inclination value of the Kalman filter to an inclination corresponding to the longitudinal acceleration sensor value or to an inclination corresponding to a value obtained by processing the longitudinal acceleration sensor value using a low-pass filter (LPF). The initialized estimated inclination value can be input to the inclination estimator 125. That is, according to an exemplary embodiment, the estimated inclination value of the previous operation (time) can be initialized to the longitudinal acceleration sensor value or the value obtained by processing the longitudinal acceleration sensor value using the LPF by the estimated value initializer 126, and the initialized estimated inclination value can be input to the inclination estimator 125 for inclination estimation of the next operation (time).
[0119] When the speed of the vehicle is significantly low, the wheel speed sensor using gears may have reduced reliability due to back lash, etc. In addition, when the vehicle stops after braking, the vehicle may vibrate due to the springs and / or shock absorbers. In view of this, when the low-speed condition that the vehicle speed is equal to or less than a preset value is met, the longitudinal acceleration sensor value can be processed using LPF. LPF can attenuate signals with frequencies higher than or equal to a specific cutoff frequency, thereby allowing only signals with frequencies lower than the cutoff frequency. Under low-speed conditions, the longitudinal acceleration sensor value can be processed using LPF, thereby improving the reliability of the longitudinal acceleration sensor value.
[0120] For example, under the low speed condition, the vehicle speed may be lower than the fifth speed (eg, 0.65 m / s). However, the low speed condition is not limited thereto, and various changes may be made in consideration of the performance of the vehicle and the characteristics of various sensors such as wheel speed sensors.
[0121] Therefore, when the low speed condition and the vehicle stop condition are satisfied, the estimated inclination value may be initialized to a value obtained by processing the longitudinal acceleration sensor value using the LPF by the estimated value initializer 126. The initialized estimated inclination value may be input to the inclination estimator 125.
[0122] In addition, when the condition immediately before the stop is satisfied, the estimated value initializer 126 may initialize the estimated inclination value to the inclination corresponding to the longitudinal acceleration sensor value. The initialized estimated inclination value may be input to the inclination estimator 125.
[0123] The estimated tilt value initialized by the estimated value initializer 126 may be input to the interference corrector 122 for interference correction.
[0124] When the vehicle does not satisfy the vehicle stop condition and the condition immediately before the stop, the system may operate normally, so that the inclination estimation may be performed normally. In this case, the estimated value initializer 126 may not initialize the estimated inclination value estimated by the inclination estimator 125. Therefore, the estimated inclination value estimated by the inclination estimator 125 may be input to the inclination estimator 125 again for inclination estimation in the next operation.
[0125] Figure 3 is a flowchart illustrating a vehicle inclination estimating method S100 according to an exemplary embodiment of the present disclosure.
[0126] Reference Figure 3, the vehicle inclination estimation method S100 according to the exemplary embodiment may include a vehicle information receiving operation S110, an interference correction operation (S130) and an inclination estimation operation (S140). In addition, the vehicle inclination estimation method S100 according to the exemplary embodiment may include at least one of a weight setting operation (S120) and an estimated value initialization operation (S150).
[0127] The vehicle inclination estimation method S100 according to an exemplary embodiment may be compared with the reference Figure 1 and Figure 2 The method implemented by the vehicle inclination estimation device 100 described above is the same. Therefore, the above description of the vehicle inclination estimation device 100 can be applied to the vehicle inclination estimation method S100. Although it is described above that the vehicle inclination estimation device 100 includes the vehicle stop determiner 121, the judgment on whether the vehicle is stopped can be performed separately in the interference correction operation (S130), the weight setting operation (S120) and the estimated value initialization operation (S150).
[0128] In the vehicle information receiving operation S110, information measured or calculated by various sensors provided in the vehicle may be received. In the vehicle information receiving operation S110, at least a portion of the following vehicle information may be received: a lateral vehicle speed 111, a yaw rate 112, a wheel speed 113 of each wheel, a longitudinal acceleration sensor value 114, a driving torque 115 of the front / rear wheels, and a longitudinal vehicle speed 116 of the vehicle.
[0129] In the interference correction operation (S130), whether the vehicle satisfies the vehicle stop condition may be determined based on the driving information, and interference of the longitudinal acceleration sensor value may be corrected according to whether the vehicle satisfies the vehicle stop condition. In the interference correction operation (S130), when the vehicle stop condition is satisfied, a value obtained by removing the longitudinal acceleration sensor value or reducing the ratio of the longitudinal acceleration sensor value may be set as a longitudinal acceleration input value input to the inclination estimation operation (S140).
[0130] In the weight setting operation (S120), the system error of the Kalman filter, i.e., the Q gain, can be arranged according to the driving conditions based on the vehicle information. In the weight setting operation (S120), the Q gain can be set by considering whether the vehicle meets the vehicle stop condition, whether the vehicle meets the condition immediately before the stop, whether the vehicle meets the ABS condition, etc. The Q gain set in the weight setting operation (S120) can be input into the inclination estimation operation (S140). In the Kalman filter used in the inclination estimation operation (S140), the Q gain can be used when the weights of the measured value (i.e., wheel speed) and the predicted value (i.e., longitudinal acceleration sensor value) change.
[0131] In the inclination estimation operation (S140), the inclination of the vehicle can be estimated using the longitudinal acceleration input value corrected in the interference correction operation (S130). In the inclination estimation operation (S140), the inclination of the vehicle can be estimated by a Kalman filter using the lateral vehicle speed, the yaw rate and the longitudinal acceleration sensor value. In the inclination estimation operation (S140), the Q gain set in the weight setting operation (S120) can be used for the Kalman filter. The inclination estimation performed by the Kalman filter can have substantially the same configuration as the inclination estimation performed by the inclination estimator 125 of the above-mentioned vehicle inclination estimation device 100.
[0132] In the estimated value initialization operation (S150), when a preset condition is met, the estimated inclination value estimated in the inclination estimation operation (S140) can be initialized. The estimated inclination value estimated in the inclination estimation operation (S140) based on the Kalman filter can be input to the estimated value initialization operation (S150). In the estimated value initialization operation (S150), when the preset condition is met, the estimated inclination value can be initialized, and then the initialized estimated inclination value can be input to the inclination estimation operation (S140). In the inclination estimation operation (S140), the initialized estimated inclination value can be used to perform inclination estimation based on the Kalman filter. The estimated value initialization operation (S150) can allow the inclination estimation to be performed even under the vehicle stop condition where the system is in a stop state.
[0133] In the following, reference is made to Figures 4 to 6 , the weight setting operation (S120), the interference correction operation (S130), and the estimation value initialization operation (S150) will be described in more detail.
[0134] Figure 4 It is shown Figure 3 Flowchart of the weight setting operation (S120) is shown.
[0135] Reference Figure 4 In the weight setting operation (S120), the system error of the Kalman filter, i.e., the Q gain, can be arranged according to the driving condition based on the vehicle information input in the vehicle information receiving operation (S110). In the weight setting operation (S120), the value of the Q gain can be set according to the driving condition. Therefore, in the Kalman filter used in the inclination estimation operation (S140), the weights of the measured value (i.e., the wheel speed) and the predicted value (i.e., the longitudinal acceleration sensor value) can be changed.
[0136] The Q gain can be constructed from a 2×2 (two by two) matrix. Figure 4In the Q gain matrix of , the A, B, C, D, and E values indicated in the 1st row and the 1st column may determine the value of the Q gain. When the A, B, C, D, and E values increase, the value of the Q gain may increase. When the A, B, C, D, and E values decrease, the value of the Q gain may decrease. In addition, Figure 4 In the Q gain matrix, the F value in the 2nd row and the 2nd column may be a constant value due to the filter noise and may be set to the same value under all conditions. Therefore, the F value may not affect the value of the Q gain.
[0137] Generally, in the Kalman filter, when the Q gain (Q value) increases, the weight of the measured value (i.e., wheel speed) may increase, and the weight of the predicted value (i.e., longitudinal acceleration sensor value) may decrease. Conversely, when the Q gain (Q value) decreases, the weight of the measured value (i.e., wheel speed) may decrease, and the weight of the predicted value (i.e., longitudinal acceleration sensor value) may increase.
[0138] Under the vehicle stop condition, a large amount of noise may appear in the longitudinal acceleration sensor value due to changes in the load movement of the vehicle and / or the vehicle being excited by the spring. Therefore, as will be described below, in the interference correction operation (S130), when the vehicle stop condition is satisfied, a value obtained by removing the longitudinal acceleration sensor value or reducing the weight of the longitudinal acceleration sensor value may be set as the longitudinal acceleration input value input to the inclination estimation operation (S140).
[0139] When the vehicle stop condition (S121) is met, the first Q gain (S121a) can be set. Under the vehicle stop condition, the longitudinal acceleration input value input to the inclination estimation operation (S140) may not reflect the longitudinal acceleration sensor value in which noise occurs, or the ratio of the longitudinal acceleration input value input to the inclination estimation operation (S140) reflecting the longitudinal acceleration sensor value may be smaller. Therefore, in order to make the Kalman filter actively use the longitudinal acceleration sensor value (prediction value) with interference eliminated, the value of the first Q gain can be reduced. As an example, the vehicle stop condition can be set to a situation where the wheel speed 113 of each of all wheels is less than a first speed (e.g., 0.15m / s) within a first time period (e.g., 1 second) and the driving torque 115 is not applied to the wheel.
[0140] When the condition (S122) immediately before the vehicle stops is satisfied, the second Q gain (S122a) may be set. The condition immediately before the stop may be a state immediately before a disturbance occurs in the longitudinal acceleration sensor value, so that the longitudinal acceleration sensor value may have high reliability. Therefore, in order to increase the weight of the longitudinal acceleration sensor value (predicted value) having high reliability, the value of the second Q gain may be reduced. As an example, the condition immediately before the stop may be a state in which the vehicle speed is less than a second speed (e.g., 0.15 m / s) within a time period less than a second time period (e.g., 1 second) and the differential value of the longitudinal acceleration sensor value is less than a preset value (e.g., 0.04).
[0141] The value of the first Q gain of the vehicle stop condition can be set to a value smaller than the value of the second Q gain of the condition immediately before the stop. In this case, under the vehicle stop condition without wheel speed, the longitudinal acceleration input value from which interference is eliminated can be actively used, and the longitudinal acceleration sensor value (predicted value) can be made to quickly approach the estimated value of the Kalman filter. In addition, the value of the second Q gain can be set to a value greater than the first Q gain, thereby reducing the ratio of the longitudinal acceleration sensor value compared to the vehicle stop condition. Therefore, in the process of changing the estimated inclination value from the condition immediately before the stop to the vehicle stop condition, the rate of change of the estimated inclination value can be reduced.
[0142] The Q gain may be set even in the ABS operating state. The condition of the ABS operating state may include a first ABS condition and a second ABS condition where the vehicle speed is higher than the first ABS condition.
[0143] When the first ABS condition, i.e., the low-speed ABS condition (S123), is met, the third Q gain (S123a) may be set. When the second ABS condition, i.e., the high-speed ABS condition (S124), is met, the fourth Q gain (S124a) may be set. The first ABS condition may correspond to the low-speed ABS condition, and the second ABS condition may correspond to the high-speed ABS condition.
[0144] In the ABS operating state, the rotation of the wheel may be restricted. Therefore, when the wheel speed is input to the Kalman filter, the reliability of the estimated inclination value may be reduced. That is, in the ABS operating state where the rotation of the wheel is restricted, the correction performance of the Kalman filter may be adversely affected. Therefore, a high level of filtering may be required to improve the reliability of the estimated inclination value. In the ABS operating state, the Q gain can be increased to increase the weight of the wheel speed (measured value) and reduce the weight of the predicted value (longitudinal acceleration sensor value). Under the ABS operating condition, the rate of change of the estimated inclination value can be reduced by increasing the Q gain. The values of the third Q gain and the fourth Q gain of the ABS operating condition can be set to be greater than the value of the first Q gain of the vehicle stop condition or the value of the second Q gain of the condition immediately before the stop.
[0145] The vehicle speed of the second ABS condition may be higher than that of the first ABS condition, thereby further increasing the adverse effect on the correction performance of the Kalman filter compared to the first ABS condition. Therefore, a higher level of filtering may be required to improve the reliability of the estimated inclination value compared to the first ABS condition. In view of this, the value of the fourth Q gain of the second ABS condition may be set to be greater than the value of the third Q gain of the first ABS condition.
[0146] For example, the first ABS condition may be set to a case where the time period elapsed from the time when the ABS control is released is less than a third time period (e.g., 0.8 seconds) and the vehicle speed is lower than a third speed (e.g., 1 m / s). The second ABS condition may be set to a case where the time period elapsed from the time when the ABS control is released is less than a fourth time period (e.g., 0.5 seconds) and the vehicle speed is higher than a fourth speed (e.g., 3 m / s).
[0147] When the vehicle stop condition ( S121 ), the condition immediately before the stop ( S122 ), the first ABS condition ( S123 ), and the second ABS condition ( S124 ) are not satisfied, the fifth Q gain ( S124 b ) may be set.
[0148] The value of the fourth Q gain (S124a) may be greater than the value of the third Q gain (S123a). The value of the third Q gain (S123a) may be greater than the value of the second Q gain (S122a). The value of the second Q gain (S122a) may be greater than the value of the first Q gain (S121a). The value of the fifth Q gain (S124b) may be greater than the value of the first Q gain (S121a). For example, in Figure 4, A of the first Q gain may be set to 1, B of the second Q gain may be set to 100, C of the third Q gain may be set to 200, D of the fourth Q gain may be set to 400, and E of the fifth Q gain may be set to 10. However, the values of the first to fifth Q gains described above are presented only for comparison, and may be variously changed when applied to an actual system.
[0149] Each Q gain set according to the driving condition in the weight setting operation (S120) may be input to the inclination estimation operation (S140). In the inclination estimation operation (S140), the inclination of the vehicle may be estimated by using the lateral vehicle speed, yaw rate, and longitudinal acceleration sensor values through a Kalman filter.
[0150] Figure 5 It is shown Figure 3 Flowchart of interference correction operation S130 is shown.
[0151] Reference Figure 5 In the interference correction operation (S130), interference of the longitudinal acceleration sensor value may be corrected based on the vehicle information input in the vehicle information receiving operation (S110).
[0152] In the interference correction operation (S130), it can be determined whether the vehicle stop condition (S131) is satisfied, and when the vehicle stop condition is satisfied, a value obtained by subtracting the estimated inclination value from the longitudinal acceleration sensor value can be set as interference (S132). Here, the estimated inclination value can be an estimated inclination value estimated in the inclination estimation operation (S140), or can be an estimated inclination value initialized in the estimated value initialization operation (S150) when the estimated value initialization operation (S150) is performed. When the vehicle stop condition is not satisfied, the interference can be set to 0 (zero) (S133).
[0153] Subsequently, a longitudinal acceleration input value (S135) input to the inclination estimation operation (S140) based on the Kalman filter may be set. Here, the longitudinal acceleration input value input to the Kalman filter may be set to a value at which interference under the vehicle stop condition is eliminated or reduced. For example, the longitudinal acceleration input value may be set to a value obtained by subtracting interference from the longitudinal acceleration sensor value. Here, interference may be the value set in operations S132 and S133.
[0154] Therefore, when the vehicle stop condition is met, the longitudinal acceleration input value input to the Kalman filter can be calculated by subtracting the disturbance in operation S132 from the longitudinal acceleration sensor value (i.e., longitudinal acceleration sensor value-estimated inclination value). That is, when the vehicle stop condition is met, the longitudinal acceleration input value calculated in operation S135 can be the estimated inclination value.
[0155] In addition, when the vehicle stop condition is not met, the longitudinal acceleration input value input to the Kalman filter can be calculated by subtracting the interference (i.e., 0) in operation S133 from the longitudinal acceleration sensor value. That is, when the vehicle stop condition is not met, the longitudinal acceleration input value calculated in operation S135 can be the longitudinal acceleration sensor value.
[0156] Therefore, in the interference correction operation (S130), when the vehicle stop condition is satisfied, the inclination input value from which interference is eliminated may be input to the inclination estimation operation (S140) instead of the longitudinal acceleration sensor value containing a large amount of noise. That is, when the vehicle stop condition is satisfied, the estimated inclination value estimated in the previous operation (time) or the estimated inclination value initialized in the estimated value initialization operation (S150) may be input as the inclination input value to the inclination estimation operation (S140).
[0157] In contrast, when the vehicle stop condition is not satisfied, the longitudinal acceleration sensor value may be input to the inclination estimating operation (S140).
[0158] Figure 6 It is shown Figure 3 4. A flow chart of the estimated value initialization operation S150 is shown.
[0159] Reference Figure 6 In the estimated value initialization operation (S150), when a preset condition is satisfied, the estimated inclination value estimated in the inclination estimating operation (S140) may be initialized.
[0160] The estimated inclination value estimated in the inclination estimation operation (S140) based on the Kalman filter may be input to the estimated value initialization operation (S150). In the estimated value initialization operation (S150), when a preset condition is satisfied, the estimated inclination value may be initialized, and then the initialized estimated inclination value may be input to the inclination estimation operation (S140). In the inclination estimation operation (S140), the Kalman filter-based inclination estimation may be performed using the initialized estimated inclination value.
[0161] First, at low speeds, the wheel speed sensor may have reduced reliability due to backlash or the like, so it may be determined whether the low speed condition is satisfied (S151).
[0162] When the low speed condition that the vehicle speed is equal to or less than the preset value is met, the longitudinal acceleration sensor value can be processed by LPF and the processed longitudinal acceleration sensor value is set to a temporary value (S152). For example, under the low speed condition, the vehicle speed can be less than the fifth speed (e.g., 0.65 m / s).
[0163] When the low speed condition is not satisfied, the longitudinal acceleration sensor value may be set to a temporary value (S153).
[0164] Subsequently, it may be determined whether the condition immediately before stopping is satisfied (S154). When the condition immediately before stopping is satisfied, the estimated inclination value input to the Kalman filter in the inclination estimation operation (S140) may be initialized to the inclination corresponding to the longitudinal acceleration sensor value (S155).
[0165] Subsequently, it can be determined whether the vehicle stop condition is met (S156). When the vehicle stop condition is met, the estimated inclination value input to the Kalman filter in the inclination estimation operation (S140) can be set to a temporary value (S157) in operation S152 or S153. Therefore, when the vehicle stop condition is met, the estimated inclination value input to the Kalman filter can be initialized to an inclination corresponding to the longitudinal acceleration sensor value or an inclination corresponding to a value obtained by processing the longitudinal acceleration sensor value using the LPF. Under low-speed conditions, the longitudinal acceleration sensor value can be processed using the LPF to improve the reliability of the longitudinal acceleration sensor value.
[0166] When the condition immediately before stopping and the vehicle stopping condition are not satisfied, the inclination may not be initialized (S158). That is, the estimated inclination value input in the estimated value initialization operation (S150) may be input again to the inclination estimation operation (S140) without initialization.
[0167] The estimated inclination value initialized in operation S155 and / or operation S157 and the estimated inclination value not initialized in operation S158 may be returned to the inclination estimation operation (S140)(S159). In addition, the estimated inclination value initialized in operation S155 and / or operation S157 and the estimated inclination value not initialized in operation S158 may be used as the estimated inclination value in operation S132 of the interference correction operation (S130).
[0168] Therefore, when the vehicle stop condition is met, the estimated inclination value input to the Kalman filter can be initialized to a preset value, and the initialized estimated inclination value can be input to the inclination estimation operation (S140), so that the initialized estimated inclination value can be used for inclination estimation in the next operation. Therefore, even in the vehicle stop condition, the reliability of the inclination estimation can be improved.
[0169] Figure 7 is a graph showing a temporal change in inclination illustrating the vehicle inclination estimation method S100 according to the example and the comparative example.
[0170] Figure 7 The inclination according to the longitudinal acceleration sensor value, the inclination estimated according to the example, the inclination estimated by the comparative example, and the actual inclination value are shown.
[0171] Figure 7 The state in which the vehicle is braked is shown at about 33.8 seconds, and the actual inclination value may be tilted downward by about 1°. Figure 7 The inclination can be converted into meters per square second (m / s 2 ), which is the value of the unit of acceleration.
[0172] Reference Figure 7 Comparing the example and the comparative example, in the comparative example, the value of the percentage overshoot (POS) may be about 700%, but in the example, the value of the overshoot may be about 100%. In addition, in the comparative example, the stabilization time for converging to the actual inclination value may be 2.2 seconds, but in the example, the stabilization time for converging to the actual inclination value may be about 1.3 seconds. That is, according to the example, it can be confirmed that the change of the estimated value is small and the stabilization time is short compared with the comparative example, so that the inclination estimation performance can be excellent.
[0173] Therefore, according to an example, the estimated inclination can have high reliability and fast response, thereby improving the reliability of vehicle control such as traction control system (TCS), idle start stop (ISG), cruise control system, brake hold, etc.
[0174] Figure 8 is a block diagram of a computer device that can fully or partially implement the vehicle inclination estimating method S100 according to an exemplary embodiment of the present disclosure.
[0175] like Figure 8 As shown, the computer device 200 may include an input interface 201, an output interface 202, a processor 204 and a memory 205. The input interface 201, the output interface 202, the processor 204 and the memory 205 may be connected to each other via a system bus 203.
[0176] In an exemplary embodiment of the present disclosure, the memory 205 may be used to store programs, instructions or codes, and the processor 204 may run the programs, instructions or codes stored in the memory 205, may control the input interface 201 to receive signals, and may control the output interface 202 to send signals. The memory 205 may include a read-only memory and a random access memory, and may provide instructions and data to the processor 204.
[0177] In the exemplary embodiments of the present disclosure, it should be understood that the processor 204 may be a central processing unit (CPU), or may be another general-purpose processor, a digital signal processor (DSP), an application-specific integrated circuit (ASIC), a field programmable gate array (FPGA) or another programmable logic device, an individual gate or transistor logic device, a single hardware component, etc. A general-purpose processor may be a microprocessor, or the processor may be any conventional processor, etc.
[0178] During implementation, the above-mentioned vehicle inclination estimation method S100 can be implemented by an integrated logic circuit of hardware or software instructions in the processor 204. The content of the vehicle inclination estimation method S100 disclosed in conjunction with the exemplary embodiment of the present disclosure can be implemented to be executed and completed by a hardware processor, or can be executed and completed by a combination of a hardware module and a software module of the processor. The software module can be set in a storage medium such as a random access memory, a flash memory, a read-only memory, a programmable read-only memory or an electrically erasable programmable memory, a register, etc. The storage medium can be located in the memory 205, and the processor 204 can read information from the memory 205 and implement the content of the vehicle inclination estimation method S100 in conjunction with the hardware. In order to avoid repeated description, its detailed description is omitted herein.
[0179] While exemplary embodiments have been illustrated and described above, it will be apparent to those skilled in the art that modifications and variations may be made without departing from the scope of the present disclosure as defined in the appended claims.
[0180] The foregoing invention may also be implemented as a computer-readable code on a computer-readable recording medium. A computer-readable recording medium is any data storage device that can store data that can then be read by a computer system and store and run program instructions that can then be read by a computer system. Examples of computer-readable recording media include hard disk drives (HDDs), solid-state drives (SSDs), silicon disk drives (SDDs), read-only memories (ROMs), random access memories (RAMs), CD-ROMs, magnetic tapes, floppy disks, optical data storage devices, and the like, as well as implementations such as carrier waves (e.g., transmitted over the Internet). Examples of program instructions include machine language codes such as those generated by a compiler, and high-level language codes that can be executed by a computer using an interpreter, etc.
[0181] In various exemplary embodiments of the present disclosure, each of the above-described operations may be performed by a control device, and the control device may be configured by a plurality of control devices or an integrated single control device.
[0182] In various exemplary embodiments of the present disclosure, the memory and the processor may be provided as one chip, or may be provided as separate chips.
[0183] In various exemplary embodiments of the present disclosure, the scope of the present disclosure includes software or machine executable commands (e.g., operating systems, applications, firmware, programs, etc.) for enabling the operations of the methods according to the various embodiments to be executed on a device or computer, and non-transitory computer-readable media storing such software or commands executable on a device or computer.
[0184] In various exemplary embodiments of the present disclosure, the control device may be implemented in the form of hardware or software, or may be implemented in a combination of hardware and software.
[0185] In addition, terms such as “unit”, “module”, etc. disclosed in the specification refer to a unit for processing at least one function or operation, and the unit can be implemented by hardware, software, or a combination of hardware and software.
[0186] For convenience of explanation and accurate definition of the appended claims, the terms "upper", "lower", "inner", "outer", "up", "down", "upward", "downward", "front", "rear", "rear", "inside", "outside", "inward", "outward", "interior", "exterior", "inside", "outside", "forward" and "rearward" are used to describe the features of the exemplary embodiments with reference to their locations as shown in the figures. It will be further understood that the term "connect" or its derivatives refer to both direct and indirect connections.
[0187] The term "and / or" may include a combination of multiple related items or any one of the multiple related items. For example, "A and / or B" includes all three situations such as "A", "B" and "A and B".
[0188] In this specification, a singular expression includes a plural expression unless the context clearly indicates otherwise.
[0189] In exemplary embodiments of the present disclosure, “at least one of A and B” may refer to “at least one of A or B” or “at least one of a combination of one or more of A and B”. In addition, “one or more of A and B” may refer to “one or more of A or B” or “one or more of a combination of one or more of A and B”.
[0190] In the exemplary embodiments of the present disclosure, it should be understood that terms such as “including” or “having” are intended to indicate that the features, numbers, steps, operations, elements, parts, or a combination thereof described in the specification are present, without excluding the possibility of adding or existing one or more other features, numbers, steps, operations, elements, parts, or a combination thereof.
[0191] For the purpose of illustration and description, the foregoing description of specific exemplary embodiments of the present invention is given. These descriptions are not intended to be exhaustive of the present invention or to limit the present invention to the precise form disclosed, and it is apparent that many modifications and variations are possible in light of the above teachings. Exemplary embodiments are selected and described to illustrate certain principles of the present invention and their practical applications so that those skilled in the art can implement and utilize various exemplary embodiments of the present invention and various alternative forms and modifications thereof. The scope of the present invention is intended to be limited by the appended claims and their equivalents.
Claims
1. A vehicle inclination estimation device, include: A vehicle information receiver, which collects driving information of the vehicle, wherein the driving information includes wheel speed, driving torque and longitudinal acceleration sensor value; a vehicle stop determiner that determines whether the vehicle satisfies a vehicle stop condition based on the travel information received from the vehicle information receiver; an interference corrector, which corrects interference of the longitudinal acceleration sensor value according to whether the vehicle stop condition is satisfied; as well as The inclination estimator estimates the inclination of the vehicle using the longitudinal acceleration input value corrected by the disturbance corrector.
2. The device according to claim 1, in, The vehicle stop condition is set based on the wheel speed received from the vehicle information receiver or based on the wheel speed and the driving torque received from the vehicle information receiver.
3. The device according to claim 1, in, The disturbance corrector sets a value obtained by removing the longitudinal acceleration sensor value or reducing a ratio of the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimator in response to the vehicle stop condition being satisfied.
4. The device according to claim 1, in, The driving information collected by the vehicle information receiver further includes the lateral speed and yaw rate of the vehicle, and The inclination estimator estimates the inclination of the vehicle through a Kalman filter using the lateral vehicle speed, the yaw rate and the longitudinal acceleration sensor value as inputs of the Kalman filter.
5. The device according to claim 4, further comprising: include: A weight setting unit arranges the system error of the Kalman filter, i.e., the Q gain, according to the driving conditions based on the vehicle information received from the vehicle information receiver, The weight setting unit sets a first Q gain in response to the vehicle stop condition being satisfied, and sets a second Q gain in response to the pre-stop condition corresponding to the situation before the vehicle stops being satisfied.
6. The device according to claim 5, in, The interference corrector: In response to the vehicle stop condition being satisfied, setting a value obtained by removing the longitudinal acceleration sensor value or reducing the ratio of the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimator, and In response to the vehicle stop condition not being satisfied, the longitudinal acceleration sensor value is set as the longitudinal acceleration input value to the inclination estimator.
7. The device according to claim 6, in, The value of the first Q gain is set to be smaller than the value of the second Q gain.
8. The device according to claim 6, in, The weight setting unit sets the third Q gain in response to the vehicle speed being within a set range in an anti-lock braking system operating state, that is, an ABS operating state, and The value of the second Q gain is set to be larger than the value of the first Q gain and smaller than the value of the third Q gain.
9. The device according to claim 6, in, The conditions of the anti-lock braking system operating state, i.e., the ABS operating state, include a first ABS condition and a second ABS condition where the vehicle speed is higher than the first ABS condition. The weight setting unit sets a third Q gain in response to satisfying the first ABS condition, and sets a fourth Q gain in response to satisfying the second ABS condition, and The value of the fourth Q gain is set to be greater than the value of the third Q gain.
10. The device according to claim 4, further comprising: include: an estimated value initializer, in response to satisfying a preset condition, initializing the estimated inclination value estimated by the inclination estimator, wherein the estimated value initializer initializes the estimated inclination value to an inclination corresponding to the longitudinal acceleration sensor value or to an inclination corresponding to a value obtained by processing the longitudinal acceleration sensor value using a low pass filter (LPF) in response to the vehicle stop condition being satisfied, and The initialized estimated inclination value is input to the inclination estimator.
11. The device according to claim 10, in, The estimated value initializer processes the longitudinal acceleration sensor value using the LPF in response to a low speed condition being satisfied that a vehicle speed has a preset value or less.
12. The device according to claim 10, in, The estimated value initializer initializes the estimated inclination value to an inclination corresponding to the longitudinal acceleration sensor value in response to a pre-stop condition being satisfied, and The initialized estimated inclination value is input to the inclination estimator.
13. The device according to claim 12, in, The estimated inclination value initialized by the estimated value initializer is input to the interference corrector and used for interference correction.
14. A method for estimating vehicle inclination, include: A vehicle information receiving operation, receiving driving information of the vehicle, wherein the driving information includes wheel speed, driving torque and longitudinal acceleration sensor value; an interference correction operation of determining whether the vehicle satisfies a vehicle stop condition based on the driving information, and correcting interference of the longitudinal acceleration sensor value according to whether the vehicle satisfies the vehicle stop condition; as well as The inclination estimating operation estimates the inclination of the vehicle using the longitudinal acceleration input value corrected in the disturbance correcting operation.
15. The method according to claim 14, in, The disturbance correction operation includes setting a value obtained by removing the longitudinal acceleration sensor value or reducing a ratio of the longitudinal acceleration sensor value as the longitudinal acceleration input value input to the inclination estimation operation in response to the vehicle stop condition being satisfied.
16. The method according to claim 14, in, The driving information received in the vehicle information receiving operation further includes a lateral vehicle speed and a yaw rate of the vehicle, and The inclination estimation operation includes estimating the inclination of the vehicle by a Kalman filter using the lateral vehicle speed, the yaw rate, and the longitudinal acceleration sensor value as inputs to the Kalman filter.
17. The method according to claim 16, further comprising: include: The weight setting operation arranges the system error of the Kalman filter, i.e., the Q gain, according to the driving conditions based on the vehicle information. wherein the weight setting operation includes setting a first Q gain in response to satisfying the vehicle stop condition, and setting a second Q gain in response to satisfying a pre-stop condition corresponding to a condition before the vehicle stops, and The value of the first Q gain is set to be smaller than the value of the second Q gain.
18. The method according to claim 16, further comprising: include: an estimated value initialization operation, in response to satisfying a preset condition, initializing the estimated inclination value estimated in the inclination estimation operation, wherein the estimated value initialization operation includes initializing the estimated inclination value to an inclination corresponding to the longitudinal acceleration sensor value or to an inclination corresponding to a value obtained by processing the longitudinal acceleration sensor value using a low pass filter (LPF) in response to the vehicle stop condition being satisfied, and The initialized estimated inclination value is input to the inclination estimation operation.
19. The method according to claim 18, in, The estimated value initialization operation includes initializing the estimated inclination value to an inclination corresponding to the longitudinal acceleration sensor value in response to a pre-stop condition being satisfied, and The initialized estimated inclination value is input to the inclination estimation operation.
20. A computer-readable storage medium recording a program for executing the method according to claim 14 on a computer.
