Use of vehicle dynamics to determine impact location

Crash detection in a road vehicle includes determining an impact location. Acceleration and yaw rate are measured, and occurrence of an impact is detected by comparing a total acceleration to an impact threshold. An impact angle is determined according to an arctangent of a ratio of lateral and longitudinal accelerations. A center-of-gravity to impact distance is determined according to vehicle mass, moment of inertia, acceleration, and yaw rate. When the yaw rate is less than a yaw threshold and the impact angle is within a predetermined range of an integer multiple of 90°, then the impact location is determined in response to a projection of the impact distance selected according to signs of the accelerations. Otherwise, the impact location is determined in response to a projection of the impact distance selected according to signs of the accelerations and a sign of the yaw rate.

BACKGROUND OF THE INVENTION

The present invention relates in general to automotive crash detection, and, more specifically, to detecting the direction of an impacting body's trajectory at the point of impact with a host vehicle and the location on the host vehicle of that point of impact.

Vehicle crash detection is a well-developed technology in the context of passive restraint systems which deploy during a crash in order to protect the vehicle occupants. Specialized sensors and robust detection algorithms provide a high reliability in detecting the onset of a crash that has a sufficient severity to automatically activate a passive restraint.

A typical crash sensing system may be comprised of an array of accelerometers, for example. Longitudinal and lateral acceleration sensor signals from the accelerometers can be generated within or communicated to a Restraints Control Module (RCM) which makes a deployment decision. Accelerometers mounted in the RCM have detection ranges from about −50 g to about +50 g. Satellite accelerometers remotely located in the front and sides of the vehicle typically have ranges from about −250 g tom about +250 g. Light to moderate impacts involving lower levels of acceleration cannot be reliably detected using the existing accelerometers. However, there would be benefits to having an ability to detect light impacts, i.e., when the impact severity is less than what the RCM module uses to initiate a restraint deployment.

Although light impacts between vehicles do not cause significant damage to the driver or passenger directly, they could begin a chain of post impact events which can lead to undesired outcomes such as further impacts or rollovers. Therefore, the detection and recording of occurrences of light impact collisions may of interest to vehicle owners, vehicle fleet operators, law-enforcement personnel, and insurance providers. This invention discloses techniques and systems for detecting light impacts to enable many different kinds of reactions such as modified vehicle control, the real-time alerting of third parties (e.g., insurance, fleet, and law enforcement agencies), and the recording/storage of incident information in the vehicle for later use by fleet operators and law enforcement for accident reconstruction.

When an impact occurs, it would be useful to automatically determine in real time not only the fact that an impact has occurred but also a direction of impact and the location along the outer perimeter of the vehicle where the impact has occurred. This information may be useful not only for reporting of incident details for accident reconstruction by crash investigators but also for real time control of vehicle systems including adapting or preparing passive restraint systems to deploy in a manner consistent with a developing situation or adjusting performance of powertrain systems for maintaining control and stability of the vehicle, for example.

SUMMARY OF THE INVENTION

In one aspect of the invention, a technique is provided for crash detection in a road vehicle which includes determining the location of an impact along an outer perimeter of the vehicle. Lateral acceleration, longitudinal acceleration, and yaw rate are measured during operation of the vehicle, wherein the lateral and longitudinal accelerations define a total acceleration. Occurrence of an impact is detected by comparing a total acceleration to an impact threshold. An impact angle is determined according to an arctangent of a ratio of the lateral and longitudinal accelerations. A center-of-gravity to impact distance is determined according to a mass of the vehicle, a moment of inertia of the vehicle, the measured accelerations, and the yaw rate. When the yaw rate is zero or less than a calibrated value and the impact angle is within a predetermined range of an integer multiple of 90°, then the impact location is determined in response to a projection of the impact distance selected according to signs of the lateral and longitudinal accelerations. Otherwise, the impact location is determined in response to a projection of the impact distance selected according to signs of the lateral and longitudinal accelerations and a sign of the yaw rate. As used herein, impact location typically means the coordinates (relative to the center-of-gravity of the vehicle) on the perimeter of vehicle where an impacting body strikes the vehicle (relative to the center-of-gravity of the impacting object).

DETAILED DESCRIPTION OF PREFERRED EMBODIMENTS

Referring toFIG. 1, a vehicle10(such as a gas, electric, or hybrid automobile or truck) includes a controller network11having various controller modules, sensors, and a multiplex bus12(e.g., a CAN bus) for transmitting data signals between the various modules and sensors. Controller modules that may be involved in implementing the present invention include a restraints control module (RCM)13with associated sensors14such as accelerometers. The passive restraint system would further include actuators such as air bags (not shown) disposed throughout vehicle10and connected to RCM13.

A body control module (BCM)15, which is coupled to bus12, is commonly present in a vehicle electrical architecture for performing general vehicle functions. BCM15provides one advantageous location for implementing the light impact detection of the invention. Controller network11further includes a powertrain controller, shown in this embodiment as an engine control module (ECM)16which is coupled to various powertrain sensors17such as a speed sensor. The vehicle may also have a traction control module comprised of an antilock brake system (ABS) module18connected to associated sensors such as wheel speed sensors.

BCM15may include, or is coupled to, a nonvolatile memory or storage20to be used in connection with crash detection and reporting. For purposes of accessing remote data and reporting impact events in real-time to remote systems (e.g., law enforcement or insurance companies), a wireless communication module21may also be connected with bus12to work in cooperation with BCM15. An antenna22is connected to wireless communication module21for establishing a data communication channel (e.g., a cellular data connection).

The purpose of the light impact detection function is to detect as quickly as possible an impact that, although not sufficiently severe to trigger deployment of a passive restraint, could create vehicle instability or significantly alter the vehicle's initial kinetic energy (either rotational or linear momentum). This function is not intended to deploy airbags or any other passive restraints. However, sensitivity to impacts needs to be much higher than what is currently used in connection with the restraints controls.

This invention, however, is not limited to light-impact events only, but is intended to detect impact locations for all type of incidents including severe impacts. By increasing the sampling time of the algorithm (i.e., by increasing the number of times the algorithm is evaluated per second using the high-speed CAN signals as input to the algorithm), the invention will allow the determination of impact locations and directions for any type of events not involving rollover.

Impact detection may be done as shown in copending U.S. application Ser. No. 16/085,374, entitled “Light Impact Detection for Vehicle Using Low Computation Overhead.” filed concurrently herewith, which was granted as U.S. Pat. No. 10,417,913, and which is hereby incorporated by reference in its entirety. In summary, the light impact detection function uses progressive monitoring stages which initially may suspect and then confirm the occurrence of an impact. Vehicle acceleration and yaw rate are measured, and possibility of an impact is recognized using the following procedure:

When the ImImpact flag remains at a value of 1 for a predetermined duration then an impact is suspected and monitoring of the vehicle dynamics is heightened. For example, if the last three consecutive InImpact flags are 1, then an Impact_Suspected flag changes from 0 to 1. In the following pseudo-code, z1, z2, and z3are the last three samples and the consecutive impact flags are InImpact[z1], InImpact[z2], and InImpact[z3]:

When Impact_Suspected[z3] equals 1, then various dynamic behaviors indicative of an impact are monitored in an attempt to confirm whether or not an impact is actually occurring. The dynamic behaviors may include checking for threshold values of the skidding of the front and rear tires, longitudinal and lateral velocity changes, continued excessive acceleration or yaw rate, and lane departure speed, for example. More specifically, an Impact_Confirmed flag may be set in response to the following vehicle dynamic behaviors.

One dynamic behavior is Change in Longitudinal Velocity. This is calculated by integrating the longitudinal acceleration axas follows:

LongVchange=∫0t⁢ax⁢dt.
When an impact is suspected, LongVchange is checked against a threshold value SpeedChangeCalibration1. When the condition abs(LongVchange)>SpeedChangeCalibration1 is satisfied, then the Impact_Confirmed flag changes from 0 to 1.

Another dynamic behavior is Change in Lateral Velocity. This is calculated by integrating the lateral acceleration ay:

When an impact is suspected, LatVchange is checked against a threshold value SpeedChangeCalibration2. When the condition abs(LatVchange)>SpeedChangeCalibration2 is satisfied, then the Impact_Confirmed flag changes from 0 to 1.

Another dynamic behavior for confirming an impact is Rate of Side-Slip Due to Yaw Motion and Lateral Acceleration. This flag checks whether the front or the rear tires exceed a threshold predefined sideslip value. The computations of the sideslips are done using the following physics based model. First, the lateral acceleration alateralis computed using the measured sensor data ay, ωz, and vxsuch that
alateral=ay−χz×vx.

Then the lateral velocity is

vlateral=∫0t⁢alateral⁢dt.
The lateral velocity due to angular yaw rate, ωz, is
vangularFT=ω×dFTfor front tires, and
vangularRT=ω×dRTfor rear tires.
The total lateral velocities of the front and the rear tires are
vlateralFT=vlateral+vangularFTfor front tires, and
vlateralRT=vlateral−vangularRTfor rear tires.
So, the sideslip ratios for the front tire and the rear tire are
SideSlipFT=vlateralFT/vxfor front tires, and
SideSlipRT=vlateralRT/vxfor rear tires.
Then the impact confirmation is obtained by using predefined threshold values, SideSlipCalibration1 and SideSlipCalibration2, of the side slip ratios for the front and the rear axles.
For the front axle,

if abs(SideSlipFT[z])> SideSlipCalibration1Impact_Confirmed[z]= 1elseImpact_Confirmed[z]= 0;end
and for the rear axle

Another dynamic behavior for confirming an impact is Lane-Departure Acceleration Threshold. The lane departure acceleration is calculated by multiplying the yaw rate and the vehicle longitudinal velocity. If this lateral acceleration exceeds a threshold value AccelerationCalibration3 then an impact is confirmed as follows:

Yet another behavior for confirming an impact is impact duration wherein the Impact_Suspected flag is integrated over time, denoted by InImpactTime. An impact is confirmed when Impact_Suspected flag is activated and InImpactTime exceeds a pre-defined threshold value ImpactDurationCalibration1.

When any of the above conditions is satisfied, the value of the Impact_Confirmed flag is set to 1. Details concerning the impact are stored in a memory (i.e., black box) and an alert may be sent to a remote system or authority (e.g., law enforcement or insurance company). The detected impact can also be used to modify vehicle powertrain operation or to modify performance of a passive restraint system.

The present invention uses acceleration and yaw rate in order to geometrically identify an angle and location of an impact. As shown inFIG. 2, vehicle10has a center of gravity (CG)25, typically slightly forward from the center of vehicle10. An impacting object26strikes vehicle10at an impact point27when moving along a line of impact28. An impact distance29is the shortest distance from CG25to line28, and is designated dCG. Distance dCGcan be calculated based on the dynamic response of vehicle10to the impact using a longitudinal acceleration ax, a lateral acceleration ay, and a yaw rate ω acting at CG25as shown inFIG. 2. In particular, knowing the total magnitude of the acceleration and the effect that acceleration has on the yaw rate, the “lever arm” over which the impact influences the yaw rate can be determined. In addition, the angle of the line of impact can be inferred based on a ratio of longitudinal acceleration axand lateral acceleration ay. Using distance dCGand the angle of impact, the x and y coordinates on the vehicle where the impact occurred is inferred using geometry.FIG. 2also indicates a vehicle forward velocity Vx.

Impact distance dCGis preferably calculated from the moment of inertia of the vehicle using the following formula:

dCG=J⁡(ω⁡[z2]-ω⁡[z1]t⁡[z2]-t⁡[z1])m⁢ax⁡[z2]2+ay⁡[z2]2
where in is the mass of the vehicle and J is the moment of inertia about CG25. Impact distance is computed only when the total acceleration exceeds a predetermined threshold so that the above calculation does not involve dividing by zero.

To reduce noise in the computation (due to inherent noise in acceleration and yaw-rate signals received over a multiplex bus) and for more accurate estimation of the impact distance, a recursive least square (RLS) algorithm is preferably used in computing the impact distance from CG25.

The impact angle is preferably found using the inverse tangent of the ratios of the lateral and longitudinal accelerations of the vehicle as shown below,

0≤θ≤π2.
As shown inFIG. 3, impact angle θ is calculated with respect to the forward direction of the vehicle (i.e., the angle between total acceleration and longitudinal acceleration). Since the arctangent returns a value between 0 and π/2 radians (i.e., 0° and 90°) regardless of the signs of the lateral and longitudinal accelerations, a final calculated impact angle further depends on those signs. More specifically, the signs of the lateral and longitudinal accelerations are used to classify an impact angle according to quadrants as shown inFIG. 4. A forward vehicle direction is at the top ofFIG. 4. Impacts occurring at close to a right angle on the back, left side, front, or right side of the vehicle are identified by narrow quadrants D1, D3, D5, and D7, respectively. For convenience, these directions can also be referred to as south, west, north, and east, respectively. Intermediate impact angles fall into wider quadrants referred to as a “southwest” direction designated D2, a “northwest” direction designated D4, a “northeast” direction designated D6, and a “southeast” direction designated D8.

In order to reduce data traffic when sending wireless crash reports over the “cloud” and to reduce onboard memory usage, the reporting and storage of crash data may use the quadrants shown inFIG. 4instead of the more precise impact angle as calculated above. The x and y coordinates where the impact occurs are calculated with good spatial resolution below. However, to again save data traffic and memory requirements, an impact location can also be reported/stored using regions L1-L16as shown inFIG. 7.

Variables used in the impact location calculation according to a preferred embodiment include the following, as shown in the indicated Figures:Half-width of the vehicle: dW(FIG. 5)Estimated impact distance from the CG: dCG(FIG. 2)Distance from CG to the front and rear end of the vehicle: Lf; Lr(FIG. 5)Distance from CG to the headlight and taillight of the vehicle: Rf; Rr(FIG. 5)Impact angle (between 0 and π radians): θAngle made by a line connecting the front headlight and rear taillight to CG with the side of the vehicle (between 0 and π radians): ϕf; ϕr(FIG. 6)Possible x-coordinates for impact: x1or x2Possible y-coordinates for impact between the front end and CG: yf1or yf2Possible y-coordinates for impact between the rear end and CG: yr1or yr2

As a first step in determining an impact location, the invention checks for a special case in which the impact direction coincides with one of the ordinal directions (i.e., D1, D3, D5, or D7) and a yaw rate generated by the impact is below a threshold value. The low yaw rate indicates that the trajectory of impact intersects with the center of gravity (i.e., generates little or no torque around the CG). Since the impact occurs at a right angle, the location of impact can thus be narrowed down to one of the four locations at the ordinal directions from the CG, shown inFIG. 8at coordinates30,31,32, or33. Moreover, the exact point can be identified based on the impact direction as identified by the signs of lateral and longitudinal acceleration. For example, if longitudinal acceleration is positive (i.e., greater than a threshold) then a rear impact has occurred at coordinate30. In the event that either yaw rate is not below the threshold or impact angle is not close to zero or 90°, then additional geometric analysis is employed to determine the impact location.

FIG. 9depicts a circle34of radius dCGaround the center of gravity using dCGas calculated above. Since the trajectory of the impacting object forms a tangent to circle34and since the impact angle θ is calculated as shown above, then there are four potential impact trajectories35-38(shown inFIG. 10) to consider. The intersections of the trajectories with the outside surface of the vehicle (shown inFIG. 11) generate potential x and y coordinates where the impact could have occurred (and the region L, if desired). Yaw rate and other factors are used to identify the actual trajectory and to select the proper coordinates. For instance, as shown inFIG. 12, two potential trajectories acting from opposite sides of the center of gravity create a yaw rate having opposite signs. Therefore, the sign of the yaw rate half of the potential trajectories. Together with the signs of the lateral and longitudinal accelerations, all but one of the trajectories is eliminated.

The invention uses various geometric projections wherein impact distance is projected according to axes/dimensions of the vehicle using the angle of impact. Variables representing various projections to be used in the analysis are as follows:
Rfs=Rf|sin(θ−ϕf)|
Rrs=Rr|sin(θ−ϕr)|
Rfs+=Rf|sin(θ+ϕf)|
Rrs+=Rr|sin(θ+ϕr)|
Lfs=Lf|sin(θ)|
Lrs=Lr|sin(θ)|
dWc=dW|cos(θ)|
dWs=dW|sin(θ)|

By way of example,FIG. 13shows projections Rrsand Lrsobtained by projecting dCGonto lines at angle θ from a rear corner of the vehicle and a rear center of the vehicle. More specifically, the projections include distances from a center-of-gravity to a vehicle front, a vehicle rear, a vehicle side, and vehicle corners, and dimensions for determining the projections include angles defined by lines between the vehicle side and the impact direction and between the center-of-gravity and the vehicle corners.

The possible coordinate locations of impact on the vehicle are then computed using the following derivations.

FIG. 14summarizes a preferred method of the invention. In step40, parameters representative of vehicle dynamics are measured including lateral and longitudinal acceleration and yaw rate. The vehicle dynamics measurements are inspected in step41to determine whether an impact is occurring. If not, the measurements continue to be collected at step40. When an impact is occurring, an impact angle is calculated in step42, e.g., using the arc tangent of a ratio of the lateral to the longitudinal acceleration. A check is performed in step43to determine whether there is a low yaw rate and whether the impact has occurred at nearly a right angle. If so, then the impact location is given in step44according to the signs of the lateral and longitudinal acceleration and the corresponding location coordinates at the vehicle surface placed at a right angle to the center of gravity of the vehicle. In step45, the impact location, impact angle, and other vehicle status parameters are stored and reported (e.g., by wireless transmission to a remote accident monitoring database). The controller network preferably encodes the impact data according to a location-direction-yaw code for providing a low transmission overhead. In step46, vehicle operation may optionally be adapted (i.e., modified) in view of the determined impact location and direction. For example, when the vehicle includes a passive restraint system for deploying a restraint to protect an occupant of the vehicle, deployment of the restraint may be adapted in response to the impact location (assuming the impact severity increases to a magnitude that triggers deployment).

When the special case is not detected in step43, then geometric analysis is used to determine impact location by first calculating an impact distance dCGin step47. In step48, projections of the impact distance are identified, and corresponding possible values of the x and y coordinates are determined. In step49, the actual x and y values are selected based on the signs of the longitudinal and lateral accelerations and the sign of the yaw rate. The thresholds used to detect the signs are defined as: εxcorresponding to the x-acceleration (ax), εycorresponding to the y-acceleration (ay), ε107corresponding to the yaw rate (ω), and εθcorresponding to the impact angle (θ).

FIGS. 15-27further delineate the analysis according to all of the potential circumstances for the acceleration and yaw rate values.

For determining when lateral or longitudinal accelerations or yaw rate is approximately zero, one or more thresholds denoted εx, εyand εωare defined as calibratable numbers close to zero (e.g., εx=0.1). Thus, wherever the absolute value of longitudinal acceleration axis less than threshold εx(i.e., |ax|≥εx), then the total acceleration is almost all a lateral acceleration (i.e., D3or D7). Whenever the absolute value of yaw rate ω is less than threshold εω(i.e., |ω|≤εω), then the impact trajectory coincides with the center of gravity (i.e., dCG≈0).

FIG. 15shows the special case which is detected in block50whenever yaw rate is about zero (i.e., |ω|≤εω) and impact angle is about 0 (as determined by angle θ being between 0 and εθ) or about π/2 radians (as determined by angle θ being between π/2−εθand π/2). When the special case is detected, then the quadrant (D1, D3, D5, or D7) of the total acceleration is determined in blocks51-54according to the sign of whichever of the longitudinal or lateral acceleration is larger than threshold εxor εy, respectively. Based on the sign of the acceleration, the x and y coordinates of the impact location are defined as shown inFIG. 15.

When the special case is not found, then impact distance dCGis calculated and the geometric projections based on impact angle θ are determined. In a preferred embodiment, the geometric analysis may preferably be organized according to the quadrant in which the total acceleration direction occurs. Thus,FIGS. 16-18yield the impact coordinates when the impact direction falls in quadrant D2.FIGS. 19-21yield the impact coordinates when the impact direction falls in quadrant D4.FIGS. 22-24yield the impact coordinates when the impact direction falls in quadrant D6.FIGS. 25-27yield the impact coordinates when the impact direction falls in quadrant D8.

When acceleration falls in quadrant D2because ax≥εxand ay≤−εy, then a corresponding one ofFIGS. 16-18is selected for finding the impact coordinates based on the sign of yaw rate ω. The sign can be positive (i.e., ω>εω), negative (i.e., ω<−εω, or none (i.e., |ε|≤εω). As shown in box55inFIG. 16, when acceleration is in quadrant D2and the sign of the yaw rate is zero (|ω|≤εω) then a geometric comparison based on the difference between impact angle θ and vehicle corner angle ϕrin boxes56,58, and60determine whether the impact coordinates are determined according to the potential values from boxes57,59, and61, respectively.

When acceleration is in quadrant D2and the sign of the yaw rate is positive (ω>−εω) as shown in box62, then the impact coordinates are found usingFIG. 17. A geometric comparison between impact angle θ and vehicle corner angle ϕrin boxes63-65determine a choice of subsequent comparisons between impact distance dCGand various ones of the projections shown in boxes66-71. The results of the chosen comparisons determine the impact coordinates selected as the final values as shown inFIG. 17.

When acceleration is in quadrant D2and the sign of the yaw rate is negative (ω<−εω) as shown in box72, then the impact coordinates are found usingFIG. 18. Geometric comparisons between impact angle θ and vehicle corner angle ϕrare performed in boxes73-75(the same comparisons as in boxes66-71inFIG. 17) determine a choice of subsequent comparisons between impact distance dCGand various ones of the projections as shown. The box for which the chosen comparison is true determines which impact coordinates are selected as the final values for x and y.

When acceleration falls in quadrant D4because ax≤−εxand ay≤−εy, then a corresponding one ofFIGS. 19-21is selected for finding the impact coordinates based on the sign of yaw rate ω. When yaw rate is near zero as shown in box80, then a geometric comparison based on the difference between impact angle θ and vehicle corner angle ϕridentifies which set of impact coordinates are selected as shown. When yaw rate is negative (ω<−εω) as shown in box81, then the impact coordinates are found usingFIG. 20. Geometric comparisons between impact angle θ and vehicle corner angle ϕrdetermine a choice of subsequent comparisons between impact distance dCGand various ones of the projections as shown. The box for which the chosen comparison is true determines which impact coordinates are selected as the final values for x and y. When the sign of the yaw rate is positive (ω>εω) as shown in box82, then the impact coordinates are found usingFIG. 21. A geometric comparison between impact angle θ and vehicle corner angle ϕrdetermines a choice of subsequent comparisons between impact distance dCGand various ones of the projections. The results of the chosen comparisons determine the impact coordinates selected as the final values as shown inFIG. 21.

When acceleration falls in quadrant D6because ax≤−εxand ay≥εy, then a corresponding one ofFIGS. 22-24is selected for finding the impact coordinates based on the sign of yaw rate ω. When yaw rate is near zero as shown in box83, then a geometric comparison based on the difference between impact angle θ and vehicle corner angle ϕridentifies which set of impact coordinates are selected as shown. When the sign of the yaw rate is positive (ω>εω) as shown in box84, then the impact coordinates are found usingFIG. 23. A geometric comparison between impact angle θ and vehicle corner angle ϕrdetermines a choice of subsequent comparisons between impact distance dCGand various ones of the projections. The results of the chosen comparisons determine the impact coordinates selected as the final values for x and y. When yaw rate is negative (ω<−εω) as shown in box85, then the impact coordinates are found usingFIG. 24. Geometric comparisons between impact angle θ and vehicle corner angle ϕrdetermine a choice of subsequent comparisons between impact distance dCGand various ones of the projections as shown. The box for which the chosen comparison is true determines which impact coordinates are selected as the final values for x and y.

When acceleration falls in quadrant D8because ax≥εxand ay≥εy, then a corresponding one ofFIGS. 25-27is selected for finding the impact coordinates based on the sign of yaw rate ω. When yaw rate is near zero as shown in box86, then a geometric comparison based on the difference between impact angle θ and vehicle corner angle ϕridentifies which set of impact coordinates are selected as shown. When yaw rate is negative (ω<−εω) as shown in box87, then the impact coordinates are found usingFIG. 26. Geometric comparisons between impact angle θ and vehicle corner angle ϕrdetermine a choice of subsequent comparisons between impact distance dCGand various ones of the projections as shown. The box for which the chosen comparison is true determines which impact coordinates are selected as the final values for x and y. When the sign of the yaw rate is positive (ω>εω) as shown in box88, then the impact coordinates are found usingFIG. 27. A geometric comparison between impact angle θ and vehicle corner angle ϕrdetermines a choice of subsequent comparisons between impact distance dCGand various ones of the projections. The results of the chosen comparisons determine the impact coordinates selected as the final values as shown inFIG. 27.