Vehicle collision avoidance steering control method, device and equipment and storage medium

By predicting the vehicle movement trajectory and calculating the steering collision avoidance path, the problem of longitudinal collision avoidance assistance in the prior art is solved, and more effective vehicle collision avoidance control is achieved.

CN118907084APending Publication Date: 2024-11-08SINO TRUK JINAN POWER CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202411174942.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-26
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

In the prior art, the vehicle collision avoidance function is only longitudinal assistance, and it is difficult to effectively avoid collisions through longitudinal braking.

Method used

By predicting the future motion trajectory of the target vehicle and the surrounding vehicles, the steering collision avoidance path is determined, and the steering wheel angle is calculated and adjusted based on the path to achieve steering collision avoidance control of the vehicle.

Benefits of technology

The vehicle collision is more effectively avoided by steering control than by longitudinal braking alone.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118907084A_ABST
    Figure CN118907084A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of auxiliary driving, in particular to a vehicle collision avoidance steering control method and device, equipment and a storage medium, and the method comprises the steps: predicting the motion track data of a target vehicle in a future preset duration and the motion track data of surrounding vehicles in front of the target vehicle in the future preset duration; according to the data, whether the target vehicle and the surrounding vehicles have the situation that collision cannot be avoided through emergency braking within the future preset duration or not is determined; if yes, determining a steering collision avoidance path of the target vehicle according to the data; and performing steering control on the vehicle according to the steering collision avoidance path. According to the method, the steering collision avoidance path equation can be accurately determined through the motion trails of the target vehicle and the front vehicle in the future for a period of time, the target vehicle is controlled to steer according to the steering collision avoidance path equation, and compared with collision avoidance only through longitudinal braking in the prior art, the collision avoidance efficiency is improved. Collision of vehicles can be more effectively avoided through steering control.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of assisted driving technology, and in particular to a vehicle collision avoidance steering control method, device, equipment and storage medium. Background Art

[0002] With the development of technology, active safety assisted driving functions represented by forward collision warning (FCW), active emergency braking system (AEB), lane keeping assist (LKA), lane departure warning (LDW), lane departure prevention (LDP), etc. have been greatly promoted and applied in commercial vehicles.

[0003] However, in the prior art, only the FCW system and the AEB system involve collision avoidance functions, and both are longitudinal collision avoidance assistance. It is difficult to effectively avoid vehicle collision only through longitudinal braking. Summary of the invention

[0004] The present application provides a vehicle collision avoidance steering control method, device, equipment and storage medium to solve the problem that in the prior art, only the FCW system and the AEB system involve collision avoidance functions, and both are longitudinal collision avoidance assistance, and it is difficult to effectively avoid vehicle collision only through longitudinal braking.

[0005] In a first aspect, the present application provides a vehicle collision avoidance steering control method, the method comprising:

[0006] Predicting the motion trajectory data of the target vehicle for a preset time period in the future and the motion trajectory data of surrounding vehicles located in front of the target vehicle for the preset time period in the future;

[0007] Determine, based on the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles, whether there is a situation in which the target vehicle and the surrounding vehicles cannot be avoided by emergency braking within the future preset time period;

[0008] If yes, determining the steering collision avoidance path of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles;

[0009] The vehicle is controlled to steer according to the steering collision avoidance path.

[0010] In a possible design, determining the steering collision avoidance path of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles includes:

[0011] The steering collision avoidance path is determined based on the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area between the target vehicle and the surrounding vehicles, so that when the target vehicle travels along the steering collision avoidance path, the target vehicle is located outside the collision risk area of ​​the surrounding vehicles.

[0012] In a possible design, determining the steering collision avoidance path according to the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area between the target vehicle and the surrounding vehicles includes:

[0013] According to the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area, the following parameters are determined: the longitudinal distance between the turning point of the steering collision avoidance path and the starting point of the steering collision avoidance path in the longitudinal direction of the target vehicle; the slope of the steering collision avoidance path at the turning point; the lateral distance between the target point and the steering collision avoidance path in the longitudinal direction of the target vehicle is determined, and the distance between the target point and the starting point of the steering collision avoidance path is N times the longitudinal distance;

[0014] An equation of the steering collision avoidance path is determined according to the longitudinal distance, the slope, and the lateral distance.

[0015] In a possible design, controlling the vehicle to steer according to the steering collision avoidance path includes:

[0016] Calculating the expected lateral acceleration of the target vehicle according to the steering collision avoidance path;

[0017] Calculating a first expected yaw rate of the target vehicle according to the expected lateral acceleration;

[0018] Calculating a second expected yaw rate of the target vehicle according to a lateral position deviation between a preview point of the target vehicle and the steering collision avoidance path;

[0019] calculating the expected steering wheel angle according to the first expected yaw rate and the second expected yaw rate;

[0020] The steering wheel angle of the target vehicle is adjusted to the expected steering wheel angle so that the target vehicle travels along the collision avoidance path represented by the collision avoidance path equation.

[0021] In a possible design, calculating the expected steering wheel angle according to the first expected yaw angular velocity and the second expected yaw angular velocity includes:

[0022] Acquiring actual yaw rate data of the target vehicle;

[0023] Calculating a steady-state yaw rate of the target vehicle according to the first desired yaw rate, the second desired yaw rate, and the actual yaw rate data;

[0024] Calculating the expected front wheel turning angle of the target vehicle according to the steady-state yaw rate, the longitudinal speed value of the target vehicle, and the wheelbase of the target vehicle;

[0025] The expected steering wheel angle is calculated according to the expected front wheel angle.

[0026] In a possible design, determining whether there is a situation in which the target vehicle and the surrounding vehicles cannot be avoided by emergency braking within the future preset time period based on the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles includes:

[0027] Calculate the time difference between the current moment and the moment when the target vehicle collides with the surrounding vehicles according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles;

[0028] Determining a preset threshold based on the speed of the target vehicle;

[0029] Determine whether the time difference is less than the preset threshold:

[0030] If so, it is determined that a collision between the target vehicle and the surrounding vehicles cannot be avoided by emergency braking within the future preset time period.

[0031] In a possible design, the predicted motion trajectory data of the target vehicle at a preset time in the future and the motion trajectory data of surrounding vehicles located in front of the target vehicle at the preset time in the future include:

[0032] Acquiring the motion state information of the target vehicle and the motion state information of the surrounding vehicles;

[0033] The motion track data of the target vehicle for a preset time period in the future and the motion track data of the surrounding vehicles in front of the target vehicle for the preset time period in the future are predicted according to the motion state information of the target vehicle and the motion state information of the surrounding vehicles.

[0034] In a second aspect, the present application provides a vehicle collision avoidance steering control device, the device comprising:

[0035] A motion trajectory prediction module is used to obtain the motion trajectory data of the target vehicle and the motion trajectory data of vehicles around the target vehicle within a preset time range after the current moment;

[0036] A steering collision avoidance path calculation module is used to determine a steering collision avoidance path equation of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles;

[0037] An expected steering wheel angle calculation module is used to calculate the expected steering wheel angle of the target vehicle according to the steering collision avoidance path equation;

[0038] The vehicle control module is used to adjust the steering wheel angle of the target vehicle to the expected steering wheel angle so that the target vehicle travels along the steering collision avoidance path represented by the steering collision avoidance path equation.

[0039] In a third aspect, the present application provides a vehicle collision avoidance steering control device, the device comprising: a processor, and a memory communicatively connected to the processor;

[0040] The memory stores computer-executable instructions;

[0041] The processor executes the computer-executable instructions stored in the memory to implement the vehicle collision avoidance steering control method as described in the first aspect.

[0042] In a fourth aspect, the present application provides a computer-readable storage medium, wherein the computer-readable storage medium stores computer-executable instructions, and when the computer-executable instructions are executed by a processor, they are used to implement the vehicle collision avoidance steering control method as described in the first aspect.

[0043] The vehicle collision avoidance steering control method, device, equipment and storage medium provided by the present application achieve the following technical effects:

[0044] Since the motion trajectories of the target vehicle and the vehicle ahead in the future are predicted, the steering collision avoidance path equation can be accurately determined, and the target vehicle can be controlled to steer according to the steering collision avoidance path equation. Compared with the prior art of avoiding collision only through longitudinal braking, steering control can more effectively avoid vehicle collisions. BRIEF DESCRIPTION OF THE DRAWINGS

[0045] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the following briefly introduces the drawings required for use in the embodiments or the description of the prior art. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0046] Figure 1 A schematic diagram of a collision avoidance steering control system provided in an embodiment of the present application;

[0047] Figure 2The vehicle collision avoidance steering control process provided in the embodiment of the present application is shown in FIG. Figure 1 ;

[0048] Figure 3 Schematic diagram of the vehicle collision avoidance steering control method provided in the embodiment of the present application Figure 2 ;

[0049] Figure 4 It is a flowchart of a method for determining whether a collision can be avoided by emergency braking provided in an embodiment of the present application;

[0050] Figure 5 This is a schematic diagram of the steering collision avoidance path planning provided by an embodiment of the present application;

[0051] Figure 6 is a schematic diagram of calculating a second desired yaw angular velocity provided in an embodiment of the present application;

[0052] Figure 7 A schematic diagram of the structure of a vehicle steering collision avoidance control device provided in an embodiment of the present application;

[0053] Figure 8 A schematic diagram of the structure of a vehicle steering collision avoidance control device provided in an embodiment of the present application. DETAILED DESCRIPTION

[0054] Exemplary embodiments will be described in detail herein, examples of which are shown in the accompanying drawings. When the following description refers to the drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The implementation methods described in the following exemplary embodiments do not represent all implementation methods consistent with the present application. On the contrary, they are merely examples of devices and methods consistent with some aspects of the present application as detailed in the attached claims, rather than all embodiments. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.

[0055] First, the relevant concepts or nouns involved in this application are explained:

[0056] Inertial Measurement Unit: An Inertial Measurement Unit (IMU) is a sensor device used to measure the specific motion state of an object. An IMU usually contains an accelerometer and a gyroscope, which can provide the following information: Acceleration: acceleration along each axis (usually the vehicle's X, Y, and Z axes); Angular velocity: rotation speed around each axis.

[0057] East-North-Up Coordinate System: It is a geographic coordinate system used to describe the position and motion state on the ground. The coordinate system is defined as follows: East: X-axis, pointing to the geographic east. North: Y-axis, pointing to the geographic north. Up: Z-axis, pointing in the opposite direction of gravity, that is, vertically upward.

[0058] Heading angle: It is the angle that describes the vehicle's heading on the horizontal plane. The specific definition is as follows: The angle between the vehicle's forward direction and the geographic north direction, usually clockwise. For example, when the vehicle is facing due north, the heading angle is 0 degrees; when facing due east, the heading angle is 90 degrees.

[0059] Collision risk area: refers to the dangerous area where a collision may occur during the driving process of the vehicle. This area is usually determined based on the vehicle's current position, speed, acceleration, and surrounding environment (such as other vehicles, obstacles, etc.).

[0060] Yaw Rate: The angular velocity of a vehicle about its vertical axis. It describes the rotational motion of the vehicle in a plane and is usually expressed in degrees per second (such as degrees / second or radians / second). Yaw rate is a very important parameter in vehicle dynamics and control systems because it directly affects the stability and handling of the vehicle.

[0061] Preview time: Preview time refers to the length of time that the system considers future path information in advance in a path tracking or driver assistance system. The longer the preview time, the earlier the system can make adjustments, thereby improving the accuracy and stability of path tracking.

[0062] Preview point: In path tracking or driver assistance systems, a preview point is a specific point on the path that the system considers in advance. Through the preview point, the system can predict the future path and make corresponding control adjustments.

[0063] Preview distance: Preview distance refers to the length of the path that the system considers in advance in path tracking or driver assistance systems. The longer the preview distance, the earlier the system can make adjustments, thereby improving the accuracy and stability of path tracking.

[0064] In the prior art, the collision avoidance function of vehicles is longitudinal collision avoidance assistance. It is difficult to effectively avoid vehicle collisions only through longitudinal braking. Therefore, the technical concept of this application is that when the vehicle cannot avoid collisions through braking, if the vehicle is turned, the collision can be effectively avoided. Specifically, the movement trajectory of the target vehicle and the vehicles around the target vehicle in the future is first predicted, and it is judged whether the vehicle cannot avoid collisions through emergency braking in the future. If so, the steering collision avoidance path equation of the target vehicle is determined based on the predicted movement trajectory data of the target vehicle and the surrounding vehicles. According to the steering collision avoidance path equation, the expected steering wheel angle of the target vehicle is calculated, and the steering wheel angle of the target vehicle is adjusted to the expected steering wheel angle to control the target vehicle to follow the steering collision avoidance path.

[0065] The technical solution of the present application and how the technical solution of the present application solves the above-mentioned technical problems are described in detail below with specific embodiments. The following specific embodiments can be combined with each other, and the same or similar concepts or processes may not be repeated in some embodiments. The embodiments of the present application will be described below in conjunction with the accompanying drawings.

[0066] Embodiment 1

[0067] This embodiment provides a vehicle collision avoidance steering control method, which can be applied to a vehicle collision avoidance steering control system. Figure 1 The following is a schematic diagram of a collision avoidance steering control system provided in an embodiment of the present application. First, the system is described. Figure 1 As shown, the system includes a fusion perception module, a vehicle state estimation module, a trajectory prediction module, an emergency collision avoidance path planning module, and a steering motion control module.

[0068] It should be noted that the above Figure 1 The division of the collision avoidance steering control system shown is only a schematic diagram. The present application does not limit the division of each module and the naming of each module. For example, in some embodiments, the above-mentioned fusion perception module can also be called a perception data processing unit, and the vehicle state estimation module can be called a vehicle dynamic evaluation unit. Therefore, the above-mentioned trajectory prediction module, emergency collision avoidance path planning module and steering motion control module can also be called a path prediction unit, an emergency path design unit and a steering control unit, respectively.

[0069] Figure 2 The vehicle collision avoidance steering control process provided in the embodiment of the present application is shown in FIG. Figure 1 Now combined Figure 1 , Figure 2 The method of this embodiment is described in detail. Figure 2 As shown, the method includes:

[0070] S201, predicting the motion trajectory data of the target vehicle for a preset time in the future and the motion trajectory data of surrounding vehicles located in front of the target vehicle for a preset time in the future;

[0071] Specifically, refer to Figure 1 In this step, the traffic environment perception sensors carried by the target vehicle, such as cameras, millimeter wave radars, and laser radars, perceive the motion status of surrounding vehicles in real time from the road traffic environment. The fusion perception module obtains the motion status data of surrounding vehicles in the target vehicle coordinate system by fusing the data sent by the traffic environment perception sensors through multi-source data. The target vehicle coordinate system can have the longitudinal direction of the target vehicle as the X-axis and the lateral direction of the target vehicle as the Y-axis. The motion status data of surrounding vehicles x T Can be:

[0072] x T =(p tx ,p ty ,v tx ,v ty )

[0073] Among them, p tx is the position data of the surrounding vehicles on the X-axis of the target vehicle coordinate system, p ty is the position data of the surrounding vehicles on the Y axis of the target vehicle coordinate system, v tx is the velocity data of the surrounding vehicles on the X-axis of the target vehicle coordinate system, v ty It is the speed data of the surrounding vehicles on the Y-axis of the target vehicle coordinate system.

[0074] The motion state data of the target vehicle can be obtained by using the sensors on the target vehicle, such as an inertial measurement unit, GPS, wheel speed meter, etc., in the east-north-sky coordinate system. H :

[0075] x H =(p hx ,p hy ,v hx ,v hy ,ψ)

[0076] Among them, p hx ,p hy is the position data of the target vehicle in the east-north-sky coordinate system, v hx ,v hy is the speed data of the target vehicle in the east-north-sky coordinate system, and ψ is the heading angle data of the target vehicle in the east-north-sky coordinate system.

[0077] It should be noted that the motion state data of the surrounding vehicles and the target vehicle are not limited to the data types involved in the above formula, but may also include acceleration data, acceleration change rate data, etc. of the surrounding vehicles and the target vehicle.

[0078] The trajectory prediction module uses the motion state data x of the surrounding vehicles T , the motion state data x of the target vehicle in the east-north-sky coordinate system H , predict the motion trajectory data of surrounding vehicles and target vehicles in the future period of time t:

[0079] X Tkn ={x Tk0 ,x Tk1 ,x Tk2 ,...,x Tkn}

[0080] in,

[0081] X Tkn The motion trajectory data of surrounding vehicles in the future period t;

[0082] x Tk0 is the motion state data of the surrounding vehicles at the current k moment;

[0083] x Tk1 The motion state data of the surrounding vehicles at time k+1;

[0084] x Tkn The motion state data of the surrounding vehicles at time k+n;

[0085] X Hkn ={x hk0 ,x hk1 ,x hk2 ,...,x hkn}

[0086] in,

[0087] X Hkn is the motion trajectory of the target vehicle in the future period of time t;

[0088] x hk0 is the motion state data of the target vehicle at the current k moment;

[0089] x hk1 is the motion state data of the target vehicle at time k+1;

[0090] x Tkn is the motion state data of the target vehicle at time k+n.

[0091] The trajectory prediction module can use the kinematic models of surrounding vehicles and target vehicles, for example, the uniform speed model, which assumes that the vehicle travels at a constant speed without considering acceleration and steering changes; the uniform acceleration model, which assumes that the vehicle travels at a constant acceleration; and the uniform angular velocity model, which assumes that the vehicle travels at a constant speed and constant angular velocity.

[0092] The trajectory prediction module can also predict the motion trajectory data of surrounding vehicles and target vehicles in the future for a period of time t through filters such as Kalman filters and particle filters.

[0093] S202, determining whether there is a situation where the target vehicle and surrounding vehicles cannot be avoided by emergency braking within a preset time period in the future based on the motion trajectory data of the target vehicle and the motion trajectory data of surrounding vehicles;

[0094] In this step, the trajectory prediction module can calculate the collision time of the target vehicle colliding with the surrounding vehicles in front through the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles, and determine whether emergency braking can avoid the collision based on the collision time.

[0095] If yes, execute step S203;

[0096] If not, execute step S205;

[0097] S203, determining a steering collision avoidance path of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of surrounding vehicles;

[0098] When it is determined that the collision cannot be avoided only by emergency braking, in this step, the emergency collision avoidance path planning module can use the Dijkstra algorithm, a shortest path algorithm based on graph search, to calculate the steering collision avoidance path, or calculate the steering collision avoidance path by a dynamic programming algorithm. When calculating the steering collision avoidance path, an important constraint is the relative distance between the target vehicle and the surrounding vehicles in front. A relative distance threshold between the target vehicle and the surrounding vehicles in front can be set as a constraint.

[0099] S204, controlling the vehicle to steer according to the steering collision avoidance path;

[0100] In this step, the steering motion control module can calculate the distance and direction between the current position of the target vehicle and a "tracking point" on the steering collision avoidance path through a pure tracking algorithm, and adjust the steering angle of the target vehicle according to the position of the tracking point; the steering motion control module can also calculate the lateral error between the current position of the target vehicle and the target path through a Stanley controller, and adjust the steering angle according to the lateral error and the heading error of the target vehicle.

[0101] S205: Control the target vehicle to perform emergency braking.

[0102] The method provided in this embodiment achieves the following technical effects:

[0103] Since the motion trajectories of the target vehicle and the vehicle ahead in the future are predicted, the steering collision avoidance path equation can be accurately determined, and the target vehicle can be controlled to steer according to the steering collision avoidance path equation. Compared with the prior art of avoiding collision only through longitudinal braking, steering control can more effectively avoid vehicle collisions.

[0104] The vehicle collision avoidance steering control method of the present application is described in detail using a specific embodiment below.

[0105] Embodiment 2

[0106] Figure 3 Schematic diagram of the vehicle collision avoidance steering control method provided in the embodiment of the present application Figure 2 In this embodiment, combined with Figure 1 , Figure 3 The method of this embodiment is described in detail. Figure 3 As shown, the method includes:

[0107] S301, predicting the motion trajectory data of the target vehicle for a preset time in the future and the motion trajectory data of the surrounding vehicles located in front of the target vehicle for a preset time in the future;

[0108] This step can be referred to in Example 1, and will not be described in detail in this example.

[0109] S302, determining whether there is a situation where the target vehicle and surrounding vehicles cannot be avoided by emergency braking within a preset time period in the future based on the motion trajectory data of the target vehicle and the motion trajectory data of surrounding vehicles;

[0110] Figure 4 is a flow chart of a method for determining whether a collision can be avoided by emergency braking provided in an embodiment of the present application, such as Figure 4 As shown, the method includes:

[0111] S401, calculating the time difference between the current moment and the moment when the target vehicle collides with the surrounding vehicles according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles;

[0112] S402, determining a preset threshold based on the speed of the target vehicle;

[0113] S403: Determine whether the time difference is less than a preset threshold:

[0114] If yes, then S404, determining that the target vehicle and surrounding vehicles cannot be prevented from colliding by emergency braking within a preset time period in the future;

[0115] If not, then S405 , determine that the target vehicle and surrounding vehicles can avoid collision through emergency braking within a preset time period in the future.

[0116] Specifically, in this embodiment, the trajectory prediction module performs Figure 4 The method shown. Figure 4 The method shown determines a preset threshold value based on the speed of the target vehicle. Since the higher the speed of the target vehicle, the greater the braking distance during emergency braking, the higher the speed of the target vehicle, the shorter the corresponding preset threshold value. The preset threshold value can be given by a deep learning model based on the current speed of the target vehicle. When the time difference from the current moment to the moment when the target vehicle collides with the surrounding vehicles is lower than the preset threshold value, it means that the collision cannot be avoided by emergency braking. At this time, the trajectory prediction module sends the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles to the emergency collision avoidance path planning module.

[0117] If yes, execute step S303;

[0118] If not, executing step S304, controlling the target vehicle to perform emergency braking;

[0119] S303, determining a steering collision avoidance path according to the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area between the target vehicle and the surrounding vehicles, so that when the target vehicle travels along the steering collision avoidance path, the target vehicle is located outside the collision risk area of ​​the surrounding vehicles;

[0120] Figure 5 is a schematic diagram of the steering collision avoidance path planning provided by the embodiment of the present application, such as Figure 5 As shown, in this step, the emergency collision avoidance path planning module determines the following parameters according to the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area of ​​the vehicle in front: the longitudinal distance between the turning point of the steering collision avoidance path and the starting point of the steering collision avoidance path in the longitudinal direction of the target vehicle; the slope of the steering collision avoidance path at the turning point; determine the lateral distance between the target point and the steering collision avoidance path in the longitudinal direction of the target vehicle, and the distance between the target point and the starting point of the steering collision avoidance path is N times the longitudinal distance.

[0121] In this embodiment, optionally, the distance between the target point and the starting point of the steering collision avoidance path is 2 times the longitudinal distance. By determining the above parameters, it is ensured that when the target vehicle travels according to the planned path, the target vehicle is always outside the collision risk area of ​​the vehicle ahead.

[0122] According to the longitudinal distance, slope, and lateral distance, the equation of the steering collision avoidance path is determined. Specifically, the equation of the steering collision avoidance path can be determined according to the following formula:

[0123]

[0124] in,

[0125] y b is the lateral distance between the target point and the steering collision avoidance path in the longitudinal direction of the target vehicle;

[0126] c is the longitudinal distance between the turning point of the steering collision avoidance path and the starting point of the steering collision avoidance path in the longitudinal direction of the target vehicle;

[0127] a is the slope of the steering collision avoidance path at the turning point.

[0128] In this embodiment, the steering collision avoidance path equation planned by the emergency collision avoidance path planning module conforms to the sigmoid function, and only the above y b The three parameters of , c, and a are used to construct the steering collision avoidance path equation. The calculation process is simple and requires low computing power. It can meet the real-time calculation of the steering collision avoidance path during vehicle driving.

[0129] S305, calculating the expected lateral acceleration of the target vehicle according to the steering collision avoidance path;

[0130] Specifically, in this step, the steering motion control module obtains the reference yaw angle ψ according to the steering collision avoidance path y(x):

[0131]

[0132] and the reference yaw rate for:

[0133]

[0134] Among them, v X is the current longitudinal speed value of the target vehicle;

[0135] According to the Ackerman steering kinematics model, the expected lateral acceleration a can be obtained: y :

[0136]

[0137] S306, calculating a first expected yaw rate of the target vehicle according to the expected lateral acceleration;

[0138] Specifically, the steering motion control module is based on the expected lateral acceleration a y , calculate the first desired yaw rate:

[0139]

[0140] is the first desired yaw rate, a yis the expected lateral acceleration, v X is the current longitudinal speed value of the target vehicle. In this step, the first expected yaw rate is calculated by the kinematic model, which has low computational complexity and certain accuracy, and can meet the high real-time requirements of vehicle driving.

[0141] S307, calculating a second expected yaw angular velocity of the target vehicle according to a lateral position deviation value between the preview aiming point of the target vehicle and the steering collision avoidance path;

[0142] Specifically, the second desired yaw rate is calculated by the following steps:

[0143] In the longitudinal direction of the target vehicle, the spatial coordinates of the preview point are determined according to the preview distance of the target vehicle;

[0144] According to the spatial coordinates of the preview point, the lateral position deviation between the preview point and the steering collision avoidance path is calculated;

[0145] According to the lateral position deviation between the preview point and the steering collision avoidance path and the current longitudinal speed of the target vehicle, the second expected yaw rate is calculated by the following formula:

[0146]

[0147] in, is the second desired yaw rate, Δy p is the lateral position deviation between the preview point and the steering collision avoidance path, V x is the current longitudinal speed of the target vehicle, d s The preview distance.

[0148] Figure 6 is a schematic diagram of calculating the second desired yaw rate provided in an embodiment of the present application, such as Figure 6 As shown, in the positive direction of the X-axis of the target vehicle's ego coordinate system, that is, the driving direction of the target vehicle, a preview point is determined at a preview distance from the origin of the target vehicle's ego coordinate system, and then the lateral position deviation between the preview point and the steering collision avoidance path is determined. The preview distance can be determined by multiplying the preset preview time with the current longitudinal speed value of the target vehicle.

[0149] S308, calculating an expected steering wheel angle according to the first expected yaw angular velocity and the second expected yaw angular velocity;

[0150] In this step, the steering motion control module calculates the desired steering wheel angle by the following method:

[0151] Obtaining actual yaw rate data of the target vehicle;

[0152] Calculating a steady-state yaw rate of the target vehicle according to the first desired yaw rate, the second desired yaw rate, and the actual yaw rate data;

[0153] Calculating the expected front wheel turning angle of the target vehicle according to the steady-state yaw rate, the longitudinal speed value of the target vehicle, and the wheelbase of the target vehicle;

[0154] Based on the desired front wheel angle, the desired steering wheel angle is calculated.

[0155] Specifically, the steady-state yaw rate is calculated according to the following formula:

[0156]

[0157] in, is the steady-state yaw rate, is the first desired yaw rate, is the actual yaw angular velocity, is the second desired yaw rate, k p is the proportionality coefficient, k I The integral coefficient, k D is the differential coefficient.

[0158] It should be noted that step S305 to step S306 calculate the first yaw rate according to the expected lateral acceleration of the target vehicle at the current moment, and it takes a certain amount of time to adjust the target vehicle to the vicinity of the steering collision avoidance path, during which the target vehicle is constantly moving, and the preview algorithm simulates the control method of human drivers turning the steering wheel in advance when facing steering. Therefore, it is not only necessary to consider the state of the target vehicle at the current moment, but also to consider the lateral position deviation of the target vehicle from the steering collision avoidance path when it travels to the preview point, and comprehensively consider the deviation of the target vehicle from the steering collision avoidance path at present and in the future.

[0159] The first expected yaw rate reflects the yaw rate required by the target vehicle according to the current state of the target vehicle. In this step, the difference between the first expected yaw rate of the target vehicle at the current moment and the actual yaw rate of the target vehicle at the current moment is calculated, and an adjustment amount is output according to the difference through the PID control algorithm. The adjustment amount reflects the yaw rate adjustment amount required for the current state of the target vehicle. On this basis, the second expected yaw rate reflecting the future state of the target vehicle is added, so as to achieve the purpose of comprehensively considering the current state and future state of the target vehicle, improve the accuracy of the lateral control of the target vehicle, and ensure that the target vehicle can travel according to the steering collision avoidance path to avoid collision with the vehicle ahead.

[0160] The steering motion control module can calculate the expected front wheel steering angle of the target vehicle according to the steady-state yaw rate using the following formula:

[0161]

[0162] Among them, V x is the current longitudinal speed of the target vehicle, L is the wheelbase of the target vehicle, K is the stability factor of the target vehicle, and δ is the expected front wheel turning angle;

[0163] Through the steady-state yaw rate, the current longitudinal speed value of the target vehicle and the relevant parameters of the target vehicle, a reliable expected front wheel steering angle can be output.

[0164] According to the expected front wheel angle, the expected steering wheel angle is calculated, which can be specifically:

[0165] δ steer_wheel = kδ

[0166] Among them, δ steer_wheel is the desired steering wheel angle, and k is the conversion ratio coefficient between the target vehicle steering wheel angle and the front wheel angle.

[0167] S309: Adjust the steering wheel angle of the target vehicle to the desired steering wheel angle, so that the target vehicle travels along the collision avoidance path represented by the collision avoidance path equation.

[0168] like Figure 1 As shown, the steering motion control module adjusts the steering wheel angle of the target vehicle to the desired steering wheel angle according to the calculated desired steering wheel angle.

[0169] The embodiment of the present invention can divide the electronic device or the main control device into functional modules according to the above method example. For example, each functional module can be divided according to each function, or two or more functions can be integrated into one processing unit. The above integrated unit can be implemented in the form of hardware or in the form of software functional modules. It should be noted that the division of modules in the embodiment of the present invention is schematic and is only a logical function division. There may be other division methods in actual implementation.

[0170] Figure 7 This is a schematic diagram of the structure of the vehicle steering collision avoidance control device provided in the embodiment of the present application. Figure 7 As shown, the device 70 comprises:

[0171] The motion trajectory prediction module 701 is used to obtain the motion trajectory data of the target vehicle and the motion trajectory data of vehicles around the target vehicle within a preset time range after the current moment;

[0172] The steering collision avoidance path calculation module 702 is used to determine the steering collision avoidance path equation of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of surrounding vehicles;

[0173] The expected steering wheel angle calculation module 703 is used to calculate the expected steering wheel angle of the target vehicle according to the steering collision avoidance path equation;

[0174] The vehicle control module 704 is used to adjust the steering wheel angle of the target vehicle to a desired steering wheel angle so that the target vehicle travels along a steering collision avoidance path represented by a steering collision avoidance path equation.

[0175] The vehicle steering collision avoidance control device provided in this embodiment can execute the vehicle steering collision avoidance control method of the above embodiment, and its implementation principle and technical effect are similar, which will not be repeated in this embodiment.

[0176] In the specific implementation of the aforementioned vehicle steering collision avoidance control device, each module can be implemented as a processor, and the processor can execute computer-executable instructions stored in the memory, so that the processor executes the aforementioned vehicle steering collision avoidance control method.

[0177] Figure 8 This is a schematic diagram of the structure of the vehicle steering collision avoidance control device provided in the embodiment of the present application. Figure 8 As shown, the electronic device 80 includes: at least one processor 801 and a memory 802. The electronic device 80 also includes a communication component 803. The processor 801, the memory 802 and the communication component 803 are connected via a bus 804.

[0178] In the specific implementation process, at least one processor 801 executes the computer-executable instructions stored in the memory 802, so that at least one processor 801 executes the vehicle steering collision avoidance control device method executed by the vehicle steering collision avoidance control device as described above.

[0179] The specific implementation process of the processor 801 can be found in the above method embodiment, and its implementation principle and technical effect are similar, so this embodiment will not be repeated here.

[0180] In the above embodiments, it should be understood that the processor may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), etc. A general-purpose processor may be a microprocessor or any conventional processor. The steps of the method disclosed in the invention may be directly implemented as being executed by a hardware processor, or may be executed by a combination of hardware and software modules in the processor.

[0181] The memory may include a high-speed RAM memory, and may also include a non-volatile storage NVM, such as at least one disk storage.

[0182] The bus may be an Industry Standard Architecture (ISA) bus, a Peripheral Component Interconnect (PCI) bus, or an Extended Industry Standard Architecture (EISA) bus, etc. The bus may be divided into an address bus, a data bus, a control bus, etc. For ease of representation, the bus in the drawings of the present application is not limited to only one bus or one type of bus.

[0183] The above-mentioned functions implemented by the electronic device and the main control device introduce the scheme provided by the embodiment of the present invention. It can be understood that in order to implement the above-mentioned functions, the electronic device or the main control device includes a hardware structure and / or software module corresponding to the execution of each function. In combination with the units and algorithm steps of each example described in the embodiment disclosed in the embodiment of the present invention, the embodiment of the present invention can be implemented in the form of hardware or a combination of hardware and computer software. Whether a function is executed in the form of hardware or computer software driving hardware depends on the specific application and design constraints of the technical solution. Those skilled in the art can use different methods to implement the described functions for each specific application, but such implementation should not be considered to exceed the scope of the technical solution of the embodiment of the present invention.

[0184] The present application also provides a computer-readable storage medium, in which computer-executable instructions are stored. When a processor executes the computer-executable instructions, the above vehicle steering collision avoidance control method is implemented.

[0185] The computer-readable storage medium mentioned above can be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk or optical disk. The readable storage medium can be any available medium that can be accessed by a general or special-purpose computer.

[0186] An exemplary readable storage medium is coupled to a processor so that the processor can read information from the readable storage medium and write information to the readable storage medium. Of course, the readable storage medium can also be a component of the processor. The processor and the readable storage medium can be located in an application specific integrated circuit (Application Specific Integrated Circuits, referred to as: ASIC). Of course, the processor and the readable storage medium can also exist as discrete components in an electronic device or a main control device.

[0187] The present application also provides a computer program product, which includes: a computer program, which is stored in a readable storage medium. At least one processor of an electronic device can read the computer program from the readable storage medium, and at least one processor executes the computer program so that the electronic device executes the solution provided by any of the above embodiments.

[0188] Those skilled in the art can understand that all or part of the steps of implementing the above-mentioned method embodiments can be completed by hardware related to program instructions. The aforementioned program can be stored in a computer-readable storage medium. When the program is executed, the steps of the above-mentioned method embodiments are executed; and the aforementioned storage medium includes: ROM, RAM, disk or optical disk and other media that can store program codes.

[0189] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, rather than to limit it. Although the present invention has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present invention.

Claims

1. A vehicle collision avoidance steering control method, characterized in that: The method comprises: Predicting the motion trajectory data of the target vehicle for a preset time period in the future and the motion trajectory data of surrounding vehicles located in front of the target vehicle for the preset time period in the future; Determine, based on the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles, whether there is a situation in which the target vehicle and the surrounding vehicles cannot be avoided by emergency braking within the future preset time period; If yes, determining the steering collision avoidance path of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles; The vehicle is controlled to steer according to the steering collision avoidance path.

2. The method according to claim 1, characterized in that The step of determining the steering collision avoidance path of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles comprises: The steering collision avoidance path is determined based on the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area between the target vehicle and the surrounding vehicles, so that when the target vehicle travels along the steering collision avoidance path, the target vehicle is located outside the collision risk area of ​​the surrounding vehicles.

3. The method according to claim 2, characterized in that The step of determining the steering collision avoidance path according to the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area between the target vehicle and the surrounding vehicles includes: According to the motion trajectory data of the target vehicle, the motion trajectory data of the surrounding vehicles, and the collision risk area, the following parameters are determined: the longitudinal distance between the turning point of the steering collision avoidance path and the starting point of the steering collision avoidance path in the longitudinal direction of the target vehicle; the slope of the steering collision avoidance path at the turning point; the lateral distance between the target point and the steering collision avoidance path in the longitudinal direction of the target vehicle is determined, and the distance between the target point and the starting point of the steering collision avoidance path is N times the longitudinal distance; An equation of the steering collision avoidance path is determined according to the longitudinal distance, the slope, and the lateral distance.

4. The method according to claim 1, characterized in that: The step of controlling the vehicle to steer according to the steering collision avoidance path comprises: Calculating the expected lateral acceleration of the target vehicle according to the steering collision avoidance path; Calculating a first expected yaw rate of the target vehicle according to the expected lateral acceleration; Calculating a second expected yaw rate of the target vehicle according to a lateral position deviation between a preview point of the target vehicle and the steering collision avoidance path; calculating the expected steering wheel angle according to the first expected yaw angular velocity and the second expected yaw angular velocity; The steering wheel angle of the target vehicle is adjusted to the expected steering wheel angle so that the target vehicle travels along the collision avoidance path represented by the collision avoidance path equation.

5. The method according to claim 4, characterized in that The calculating the expected steering wheel angle according to the first expected yaw angular velocity and the second expected yaw angular velocity includes: Acquiring actual yaw rate data of the target vehicle; Calculating a steady-state yaw rate of the target vehicle according to the first desired yaw rate, the second desired yaw rate, and the actual yaw rate data; Calculating the expected front wheel turning angle of the target vehicle according to the steady-state yaw rate, the longitudinal speed value of the target vehicle, and the wheelbase of the target vehicle; The expected steering wheel angle is calculated according to the expected front wheel angle.

6. The method according to claim 1, characterized in that The determining, based on the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles, whether there is a situation where the target vehicle and the surrounding vehicles cannot be collided with each other by emergency braking within the future preset time period includes: Calculate the time difference between the current moment and the moment when the target vehicle collides with the surrounding vehicles according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles; Determining a preset threshold based on the speed of the target vehicle; Determine whether the time difference is less than the preset threshold: If so, it is determined that a collision between the target vehicle and the surrounding vehicles cannot be avoided by emergency braking within the future preset time period.

7. The method according to any one of claims 1 to 6, characterized in that: The predicted motion trajectory data of the target vehicle for a preset time period in the future and the motion trajectory data of surrounding vehicles located in front of the target vehicle for the preset time period in the future include: Acquiring the motion state information of the target vehicle and the motion state information of the surrounding vehicles; The motion track data of the target vehicle for a preset time period in the future and the motion track data of the surrounding vehicles in front of the target vehicle for the preset time period in the future are predicted according to the motion state information of the target vehicle and the motion state information of the surrounding vehicles.

8. A vehicle collision avoidance steering control device, characterized in that: The device comprises: A motion trajectory prediction module is used to obtain the motion trajectory data of the target vehicle and the motion trajectory data of vehicles around the target vehicle within a preset time range after the current moment; A steering collision avoidance path calculation module is used to determine a steering collision avoidance path equation of the target vehicle according to the motion trajectory data of the target vehicle and the motion trajectory data of the surrounding vehicles; An expected steering wheel angle calculation module is used to calculate the expected steering wheel angle of the target vehicle according to the steering collision avoidance path equation; The vehicle control module is used to adjust the steering wheel angle of the target vehicle to the expected steering wheel angle so that the target vehicle travels along the steering collision avoidance path represented by the steering collision avoidance path equation.

9. A vehicle collision avoidance steering control device, characterized in that: The device comprises: a processor, and a memory communicatively connected to the processor; The memory stores computer-executable instructions; The processor executes the computer-executable instructions stored in the memory to implement the vehicle collision avoidance steering control method according to any one of claims 1 to 7.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer-executable instructions, and when the computer-executable instructions are executed by a processor, they are used to implement the vehicle collision avoidance steering control method according to any one of claims 1 to 7.

Citation Information

Cited By

  • Vehicle emergency braking control method, computing device, vehicle and storage medium

    CN122126285A