Method and system for obstacle avoidance involving control of steering system and differential braking system
By detecting obstacles and optimizing the coordinated control of steering and differential braking systems, the problem of motor vehicles avoiding obstacles during high-speed driving is solved, the stability and controllability of the vehicle are achieved, and the design and development of the control system are simplified.
Patent Information
- Application Number
- CN201980074929.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2018-11-13
- Filing Date
- 2019-10-25
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2039-10-25
AI Technical Summary
The prior art is difficult to effectively avoid collisions between motor vehicles and obstacles when driving at high speed, especially when there is another vehicle behind the vehicle, and it is difficult to ensure the stability and controllability of the vehicle at the same time.
By detecting obstacles and planning avoidance paths, controlling steering and differential braking systems, limiting the amplitude and gradient of torque, ensuring vehicle controllability and stability, and optimizing steering and difference with closed-loop controllers and feedforward controllers The coordinated operation of the brake system.
It realizes safe avoidance when driving at high speed, ensures the stability and controllability of the vehicle, reduces the risk of slippage during sharp turns, and simplifies the design and development of control systems.
Smart Images

Figure CN113039104B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of motor vehicles and in particular to driver assistance systems for preventing collisions.
[0002] Accidents due to emergency situations such as a collision with another vehicle, a pedestrian or a cyclist account for a large proportion of road traffic accidents.
[0003] It is known practice to use driving assistance systems, such as automatic emergency braking systems (abbreviated AEB), to avoid a collision between a motor vehicle and an obstacle in the vehicle's path by using conventional braking systems. However, there are many situations that cannot be effectively handled by such emergency braking systems, especially when the motor vehicle is traveling at high speeds. In particular, when the motor vehicle is traveling at high speeds and there is another vehicle behind the vehicle, it is not possible to avoid the collision or to apply the brakes. In such cases, it is preferred to steer the wheels of the vehicle to achieve a lateral avoidance path.
[0004] A driver assistance system called Automatic Evasive Steering (abbreviated AES) is known and enables collision avoidance by activating the steering / differential braking system for a limited duration to avoid a collision with an obstacle. The obstacle may be in the same lane as the motor vehicle, or in an adjacent lane.
[0005] One of the goals of designing a safe and reliable AES system is to create a high-performance, optimal and robust controller capable of executing predefined avoidance paths. In extreme cases, this involves automatic lane changes at longitudinal speeds of up to 160 km / h.
[0006] The stability and controllability limits of a motor vehicle have a significant impact on the performance capabilities of an AES controller. Specifically, the magnitude and gradient of the torque required by an AES controller for electric power steering need to be limited so that the driver can always take back manual control of the steering wheel. Furthermore, vehicle dynamics (especially such as yaw angle, yaw rate) need to be limited to avoid a loss of grip between the tires and the ground that could endanger the driver.
[0007] In order to circumvent these limitations regarding the controllability and stability of motor vehicles, it is known to combine a steering system with a differential braking system. In particular, the steering system is particularly effective at moderate speeds, while the differential braking system improves the handling dynamics of the vehicle at high speeds. Furthermore, the combination of the two actuators ensures good vehicle stability and, for example, enables slip to be reduced during evasive maneuvers in tight turns. Background Art
[0008] Reference may be made, for example, to document WO 2007 73 772-A1, which describes a system configured to control both a steering system and a differential braking system to avoid the risk of oversteering of the vehicle. However, this document does not propose any dynamic model of the vehicle.
[0009] Reference may also be made to document FR 2 695 613-A1, which describes a method for automatically correcting the occurrence of yaw movements of a motor vehicle of the road vehicle type by applying a braking torque to one or more wheels of the vehicle. This document does not propose an obstacle avoidance method.
[0010] Also known are documents EP 1 790 542-A1 and KR 10 085 11 20, which relate to lane departure avoidance methods based solely on systems for differential braking of the wheels. However, these documents do not address the problem of following an obstacle avoidance path, nor the controllability and stability of the vehicle.
[0011] Therefore, in the context of automatic obstacle avoidance, there is a need to optimize the simultaneous control of both the steering system and the differential braking system in order to execute an avoidance path that takes into account the controllability limits associated with the vehicle torque and the stability of the motor vehicle. Summary of the invention
[0012] Therefore, an object of the present invention is to propose a reliable and simple obstacle avoidance system and method.
[0013] A subject of the invention is an obstacle avoidance method, wherein:
[0014] - detecting obstacles in the vicinity of the motor vehicle and planning a path to avoid said obstacles, and
[0015] - controlling a steering system and / or a differential braking system configured to maneuver the avoidance path.
[0016] Advantageously, when controlling the steering system and / or the differential braking system, controllability constraints are defined in which the magnitude and the gradient of the steering torque are limited, and stability constraints are defined in which the slip rate and the yaw rate of the vehicle are bounded.
[0017] For example, a check is performed to determine whether the controllability constraint is observed, and if the constraint is observed, only the steering of the wheels is controlled.
[0018] Specifically, in this case, once the required steering torque is bounded by the controllability limit, the steering of the wheels is sufficient to perform the evasive maneuver. In this case, the contribution from differential braking is zero.
[0019] If, on the other hand, the constraints are not observed, the differential braking system is controlled.
[0020] For example, when the ratio of the lateral avoidance offset to the longitudinal avoidance distance is too large.
[0021] In this case, differential braking needs to be active in order to assist with steering and correctly follow the evasive path. If differential braking does not contribute, the path achieved will be incorrect and could endanger the motor vehicle.
[0022] Parameter α DB It is the only parameter that needs to be controlled in order to operate the steering system and differential braking system.
[0023] For example, the following assumptions can be made:
[0024] - the magnitude and gradient of the steering torque do not exceed the controllability limits,
[0025] -The avoidance path is predefined,
[0026] - modeling the behavior of the differential brake by means of the yaw moment; and
[0027] -The path curvature is zero.
[0028] A second aspect of the invention relates to a module for controlling a steering system and / or a differential braking system and which is configured to send a wheel steering setpoint to a wheel steering computer of a motor vehicle and a yaw moment setpoint to a braking computer of said motor vehicle.
[0029] Advantageously, the module comprises a closed-loop controller for the steering system, the closed-loop controller being configured to follow a reference avoidance path and to respond to stability constraints of the vehicle.
[0030] For example, the module further includes a feed-forward controller configured to compensate for the effect of the path deviation on the path following error.
[0031] The module may also include a closed-loop controller for the differential braking system, the closed-loop controller being configured to improve the performance of the steering loop, particularly under torque saturation and vehicle stability conditions.
[0032] A third aspect of the present invention relates to an obstacle avoidance system, which comprises: an obstacle detection module, which detects obstacles near a motor vehicle and plans an obstacle avoidance path for avoiding the obstacles; and a control module as described above, which is used to control a steering system and / or a differential braking system.
[0033] Another aspect of the invention relates to a motor vehicle comprising: a system for determining the position of the motor vehicle relative to its lane (such as, for example, a front camera), and the system is capable of determining the lateral offset from the lane markings at line of sight distance and the relative heading angle of the vehicle; an obstacle detection system (for example, a front radar) for detecting obstacles in the path of the vehicle, the obstacle detection system being configured to determine the longitudinal distance and overlap of the obstacle relative to the vehicle; a gyroscope; automatic power steering; a control module as described above, which controls the steering system and / or the differential braking system; a computer, which is configured to convert a steering angle set point from the control module into a torque limit for the power steering in order to perform steering; a computer, which is configured to convert a yaw moment set point from the control module into a torque at the wheels in order to perform differential braking; and a sensor, which measures the rotation angle and rotation rate of the steering wheel. BRIEF DESCRIPTION OF THE DRAWINGS
[0034] Further objects, features and advantages of the present invention will become apparent from a reading of the following description, given by way of non-limiting example only, and made with reference to the accompanying drawings, in which:
[0035] - Figure 1 schematically depicts an obstacle avoidance maneuver performed by an obstacle avoidance system according to the present invention, the obstacle avoidance system comprising a control module that controls a steering (DAE) system and / or a differential braking system configured to manipulate an avoidance path;
[0036] - Figure 2 Schematically depicts Figure 1 Obstacle avoidance system;
[0037] - Figure 3 Shown by Figure 1 A flowchart of the obstacle avoidance method implemented by the system;
[0038] - Figure 4 Details of the steps of controlling a steering (DAE) system and / or a differential braking system configured to maneuver an avoidance path are presented.
[0039] Figure 1 An obstacle avoidance maneuver performed by the obstacle avoidance system 10 is depicted very schematically.
[0040] The obstacle avoidance system 10 includes: an obstacle detection module 12, which detects an obstacle 1 near the motor vehicle 2 and plans an obstacle avoidance path for avoiding the obstacle; a control module 14, which controls a steering (DAE) system and / or a differential braking system configured to manipulate the avoidance path; and a module 16, which is used to stop the operation of the steering (DAE) system and / or the differential braking system once the motor vehicle is at a predetermined distance from the obstacle 1.
[0041] The motor vehicle 2 comprises a system for determining the position of the motor vehicle relative to its lane (such as, for example, a front camera), and the system is capable of determining the lateral offset yL relative to the lane markings at line-of-sight distance and the relative heading angle ΨL of the vehicle. The motor vehicle 2 is also provided with an obstacle detection system (e.g., a front radar) for detecting obstacles in the path of the vehicle, the obstacle detection system being configured to determine the longitudinal distance and overlap of obstacles relative to the vehicle.
[0042] like Figure 2 As shown, the motor vehicle 2 also includes: a gyroscope (not depicted); an automatic power steering DAE capable of executing a torque set point generated by a steering (DAE) system and / or a differential braking system control module 14; a computer 20 configured to convert a steering angle set point into a torque limit on the power steering DAE in order to perform steering; a braking unit BRAKE UNIT capable of executing a torque set point generated by a steering (DAE) system and / or a differential braking system control module 14; a computer 22 configured to convert a yaw moment set point into a torque at the wheel in order to perform differential braking; and a sensor for measuring a steering wheel rotation angle and a rotation rate.
[0043] The steering (DAE) system and / or differential braking system control module 14 is configured to send a wheel steering setpoint δref to a wheel steering computer 20 and a yaw moment setpoint MDB_Ref to a computer 22 .
[0044] The steering (DAE) system and / or differential braking system control module 14 includes a closed-loop controller 24 for the steering system that is configured to follow a reference avoidance path and respond to vehicle stability constraints.
[0045] The steering (DAE) system and / or differential braking system control module 14 further includes a feed-forward controller 26 configured to compensate for the effect of path deviation on path following error.
[0046] Finally, the steering (DAE) system and / or differential braking system control module 14 includes a closed loop controller 28 for the differential braking system and is configured to improve the performance of the steering loop, particularly in torque saturation and vehicle stability conditions.
[0047] like Figure 3 As shown, the obstacle avoidance method 30 includes: a step 32 of detecting an obstacle 1 near the motor vehicle 2 and planning an obstacle avoidance path for avoiding the obstacle; a step 34 of controlling a steering (DAE) system and / or a differential braking system configured to manipulate the avoidance path; and a step 36 of stopping the operation of the steering (DAE) system and / or the differential braking system once the motor vehicle is at a predetermined distance from the obstacle 1.
[0048] Figure 4 The step 34 of controlling a steering (DAE) system and / or a differential braking system configured to maneuver an avoidance path is presented in detail.
[0049] To model the dynamics of a motor vehicle controlled by a steering system and a differential braking system, the following assumptions are made at step 40:
[0050] When the magnitude and gradient of the steering torque do not exceed the controllability limits, the behavior of the power steering is modeled by the following equations:
[0051] in,
[0052] [Mathematical formula 1]
[0053]
[0054] in:
[0055] δ is the angle between the front wheels and the longitudinal axis of the vehicle, expressed in rad;
[0056] δ ref is the setpoint angle of the front wheels, expressed in rad; and
[0057] ξ and ω are two constants that characterize the actual angle of the front wheels.
[0058] Another assumption made is that the avoidance path is predetermined, modeling the behavior of the differential brake by the yaw moment. Specifically, the yaw moment is generated by a brake unit controlled by a computer that is carried on the vehicle and converts the yaw moment set point into a braking torque applied to each wheel.
[0059] The final assumption made is that the curvature is assumed to be zero. If the curvature is non-zero, the controller can be easily calculated (e.g. feed-forward following type) to eliminate the effect of curvature on the path.
[0060] If the yaw moment generated by differential braking cannot be estimated, consider the following equation:
[0061] [Mathematical formula 2]
[0062]
[0063] in:
[0064] β is the yaw angle, expressed in rad;
[0065] r is the yaw rate, expressed in rad / s;
[0066] y L is the lateral offset between the axis of the vehicle and the tangent to the vehicle's forward path, expressed in m;
[0067] Ψ L is the relative heading angle between the axis of the vehicle and the tangent of the reference path, expressed in rad / s; and
[0068] δ is the angle between the front wheels and the longitudinal axis of the vehicle, expressed in rad;
[0069] c f is the turning stiffness of the front wheel, expressed in N / rad;
[0070] c r is the turning stiffness of the front wheel, expressed in N / rad;
[0071] V is the speed of the vehicle along the longitudinal axis, expressed in m / s;
[0072] M DB_ref is the yaw moment set point, expressed in Nm;
[0073] α DB is the yaw angle, expressed in rad.
[0074] If the yaw moment generated by differential braking can be estimated, the following equation is considered:
[0075] [Mathematical formula 3]
[0076]
[0077] in:
[0078] is the yaw moment, expressed in Nm.
[0079] The dynamics of the differential braking system can be written according to the following equations:
[0080] [Mathematical formula 4]
[0081]
[0082] in:
[0083] M DB_ref is the yaw moment set point, expressed in Nm; and
[0084] is the yaw moment, expressed in Nm.
[0085] Therefore, the yaw moment (rotation) and its dynamics are introduced into the control of the differential braking system. In addition, the parameter α is introduced DB ∈[0, 1] allows steering and differential braking to be controlled simultaneously. DB = 0, no differential braking is required; steering alone is sufficient to follow the avoidance path. DB = 1, the full capacity of differential braking will be used to assist steering and thus achieve dynamic evasive maneuvers. However, it is not always necessary to use 100% of differential braking, and in these cases, α takes a value between 0 and 1 inclusive.
[0086] The step 34 of controlling the steering (DAE) system and / or the differential braking system further comprises: a step 42 of defining controllability constraints in which the magnitude and gradient of the torque TAES are limited; and a step 44 of defining stability constraints in which the slip rate and yaw rate r of the vehicle are bounded.
[0087] Equation Mathematical Formula 3 can be rewritten as follows:
[0088] [Mathematical formula 5]
[0089]
[0090] in:
[0091] [Mathematical formula 6]
[0092]
[0093] The equation Mathematical Formula 4 can be written in the form of a variable linear parameter system as follows:
[0094] [Mathematical formula 7]
[0095]
[0096] in:
[0097] [Mathematical formula 8]
[0098]
[0099]
[0100] The step 34 of controlling the steering (DAE) system and / or the differential braking system further comprises: a step 45 of verifying whether the controllability constraints are observed or no longer observed; and a step 46 of controlling the steering system if the controllability constraints are observed. Once the required steering torque is bounded by the controllability limits, the steering of the wheels alone is sufficient to achieve the evasive maneuver. In this case, the contribution of the differential braking is zero.
[0101] In this case, the following model is considered to synthesize the control law:
[0102] [Mathematical formula 9]
[0103]
[0104] in:
[0105] α DB =0.
[0106] The mathematical formula of equation 9 can be written as follows:
[0107] [Mathematical formula 10]
[0108]
[0109] in:
[0110] [Mathematical formula 11]
[0111]
[0112] [Mathematical formula 12]
[0113]
[0114] [Mathematical formula 13]
[0115]
[0116] [Mathematical formula 14]
[0117]
[0118] [Mathematical formula 15]
[0119]
[0120] [Mathematical formula 16]
[0121]
[0122] The gain can be calculated using the following equation
[0123] [Mathematical formula 17]
[0124]
[0125] Will Substituting into equation 10, we get the closed-loop system:
[0126] [Mathematical formula 18]
[0127]
[0128] Feedforward The calculation is to convert the error e in the steady state yL Decreases to zero (correctly following the path in steady state):
[0129] [Mathematical formula 19]
[0130]
[0131] Solving equation Mathematical Formula 19 yields:
[0132] [Mathematical formula 20]
[0133]
[0134] The step 34 of controlling the steering (DAE) system and / or the differential braking system further comprises a step 48 of controlling the differential braking system if the controllability constraints are not or no longer observed, for example when the ratio of the lateral avoidance offset to the longitudinal avoidance distance is too large.
[0135] In this case, differential braking needs to contribute to assist steering and correctly follow the evasive path. If differential braking does not contribute, the path followed will be incorrect and may endanger the motor vehicle.
[0136] Parameter α DB It is the only parameter that is controlled in order to operate the steering system and the differential braking system.
[0137] Use the following equation to calculate the parameter α DB :
[0138] [Mathematical formula 21]
[0139]
[0140] is calculated as follows:
[0141] [Mathematical formula 22]
[0142]
[0143] Among them, d a ≥0,d s ≥0 is a weighting parameter (to be chosen during the development phase). For example, if d s ≥d a , then in the differential braking requirement, the weight of gradient saturation is greater than the weight of amplitude saturation, and vice versa.
[0144] Finally, the function The activation function chosen is the sigmoid:
[0145] [Mathematical formula 23]
[0146]
[0147] a0>0 and Δ0≥0 are two parameters that will be selected during development on the vehicle to achieve the desired vehicle behavior. The differential braking (to steering saturation under controllability constraints) reacts less quickly when (a0=4, Δ0=2) than when (a0=4, Δ0=1).
[0148] Make the following assumptions:
[0149] [Mathematical formula 24]
[0150] as well as
[0151] Feedforward Gain Can eliminate in steady state Considering the fact that the path following error is affected, the equation [Mathematical Formula 7] can be written as:
[0152] [Mathematical formula 7a]
[0153]
[0154] The final goal is to find the control law that follows the static state return:
[0155] [Mathematical formula 25]
[0156] M DB_ref =K M x
[0157] For this purpose, consider the following general system:
[0158] [Mathematical formula 26]
[0159]
[0160] in:
[0161] x s is the state vector;
[0162] u s is the control input;
[0163] A s and B s is a matrix of appropriate dimensions; and
[0164] θ is a X of vertices θ A vector of known and bounded extrinsic parameters in the polyhedron.
[0165] [Mathematical formula 27]
[0166] X θ ={θ i_min ≤θ i ≤θ i_max , i=1:N θ}
[0167] Consider a controller that returns based on a static state of the following form:
[0168] [Mathematical formula 28]
[0169] u s =K s x s
[0170] Some conditions need to be defined. This condition is expressed by the following equation:
[0171] [Mathematical formula 29]
[0172]
[0173] in:
[0174] is the number of bounded states, h 0j is a positive and known constant, H 0j is the vector of states involved in the selection.
[0175] This criterion is used to ensure the stability of the vehicle during emergency (dynamic) maneuvers. The stability constraint is guaranteed by applying the following inequality:
[0176] [Mathematical formula 30]
[0177] |[0 1 0 0 0 0 0]x|≤r max
[0178] [Mathematical formula 31]
[0179] |[1 0 0 0 0 0 0]x|≤β maxThe poles of the closed-loop system need to be defined by the radius γ, the minimum distance μ relative to the imaginary axis, and the opening angle This criterion is used in order to have a control set point that is reasonable and achievable by the actuator.
[0180] In order to respond to the criteria regarding bounded state, the following conditions need to be met.
[0181] [Mathematical formula 32]
[0182]
[0183] In order to respond to the criteria regarding closed-loop poles, the following LMI conditions need to be met:
[0184] [Mathematical formula 33]
[0185] A k Q+BR+(A k Q+BR) T +2μQ<0;R=K P-1 in
[0186] [Mathematical formula 34]
[0187] in
[0188] [Mathematical formula 35]
[0189]
[0190] in,
[0191] In the above equation, A k It is in X θ A calculated from the kth vertex of the polyhedron s (θ) matrix.
[0192] Once equations 31 to 35 are solved, this gives the value of the static state return vector K which is applied to the control laws for the steering system and the differential braking system.
[0193] By means of the present invention, the automatic calculation of the gain K of the controller makes it possible to reduce the design time of the control method for the steering system and the braking system. The two-step steering and differential braking control method allows traceability and thus makes development easier. Specifically, the step of controlling the steering is performed to meet the requirements in the nominal case. Then the step of controlling the differential braking is performed for special cases (torque saturation, etc.).
[0194] In addition, when using only one parameter α DBIn this case, it is simple to manipulate the steering system and the differential braking system while complying with the controllability constraints and the stability constraints.
[0195] Throughout this application, the curvature is clearly responsive to the curvature of the road, the invention can be applied regardless of the curvature, and when the curvature is non-zero, the controller (e.g. of the feed-forward type) allows to eliminate the effects of curvature on following the path.
Claims
1. An obstacle avoidance method (30), wherein: - detecting an obstacle (1) in the vicinity of the motor vehicle (2) and planning an obstacle avoidance path for avoiding said obstacle, and - controlling a steering (DAE) system and a differential braking system configured to steer the obstacle avoidance path, Therein, when controlling the steering (DAE) system and the differential braking system, controllability constraints are defined, in which the amplitude and gradient of the steering torque (TAES) are limited, and stability constraints are defined, in which the slip rate and yaw rate (r) of the motor vehicle are limited.
2. The method (30) of claim 1, wherein: A check is performed to determine whether the controllability constraint is observed, and the steering of the wheels is only controlled if the controllability constraint is observed.
3. The method (30) of claim 2, wherein: If the controllability constraints are not observed, the differential braking system is controlled.
4. A method as claimed in any one of the preceding claims, wherein: The following assumptions are made: - the magnitude and gradient of the steering torque do not exceed the controllability limits, -The obstacle avoidance path is predefined, - modeling the behavior of the differential braking system through yaw torque; and -Road curvature is zero.
5. A control module (14) for controlling a steering (DAE) system and a differential braking system, and the control module is configured to send a wheel steering set point (δref) to a wheel steering computer of a motor vehicle (2) and to send a yaw moment set point (MDB_Ref) to a braking computer of the motor vehicle, wherein: The control module is configured to define controllability constraints in which the magnitude and the gradient of the steering torque (TAES) are limited and to define stability constraints in which the slip rate and the yaw rate (r) of the motor vehicle are bounded.
6. The control module (14) of claim 5, comprising a closed-loop controller (24) for the steering system configured to follow a reference avoidance path and respond to stability constraints of the motor vehicle.
7. The control module (14) of claim 5 or 6, further comprising a feedforward controller (26) configured to compensate for the effect of path deviation on path following error.
8. A control module (14) as claimed in claim 5 or 6, comprising a closed loop controller (28) for the differential braking system configured to improve the performance of the steering loop.
9. The control module (14) according to claim 8, wherein: The closed-loop controller (28) for a differential braking system is configured to improve the performance of the steering loop under torque saturation and vehicle stability conditions.
10. An obstacle avoidance system (10), comprising: An obstacle detection module (12) detects an obstacle (1) near the motor vehicle (2) and plans an obstacle avoidance path for avoiding the obstacle; And a control module (14) according to any one of claims 5 to 9, which is used to control a steering (DAE) system and a differential braking system.
11. A motor vehicle (2), comprising: A system for determining the position of the motor vehicle relative to its lane and capable of determining the lateral offset (yL) relative to the lane markings at line of sight and the relative heading angle (ΨL) of the motor vehicle; an obstacle detection system for detecting obstacles in the path of the motor vehicle, the obstacle detection system being configured to determine the longitudinal distance and overlap of the obstacle relative to the motor vehicle; a gyroscope; automatic power steering (DAE); a control module (14) as claimed in any one of claims 5 to 9, the control module controlling the steering (DAE) system and the differential braking system; a first computer (20) configured to convert a steering angle set point from the control module (14) into a torque limit for the power steering (DAE) in order to perform steering; a second computer (22) configured to convert a yaw moment set point from the control module (14) into a torque at the wheels in order to perform differential braking; and a sensor measuring the rotation angle and rotation rate of the steering wheel.
